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Abstract 

This  study  treats  the  high  accuracy  tracking  of  a satellite  from  an  air- 
craft. The  purpose  is  to  evaluate  the  feasibility  of  several  reduced  order 
system  models  for  implementation  in  an  extended  Kalman  filter  formulation 
whose  estimates  would  be  used  to  aid  the  tracker.  The  first  filter  model  is 
a twelve  state  model  in  which  filter  estimates  of  the  satellite  inertial  posi- 
tion and  velocity  are  obtained  and  used  in  the  estimation  of  the  tracker 
states.  A second,  six  state-model  deletes  these  six  satellite  states,  and 
tracker  state  estimation  is  accomplished  by  exploiting  the  information 
already  available  in  the  tracking  geometry,  dominant  modes  of  satellite 
dynamics,  and  the  range  measurement.  Tracker  state  estimation  is  accomplished 
in  the  line  of  sight  coordinate  frame  for  both  filter  formulations.  A 
covariance  analysis  was  performed,  evaluating  each  filter  against  a 42  state 
truth  model.  The  tracking  profile  used  in  the  study  was  specifically 
designed  to  evaluate  each  filter's  state  estimation  capability  when  faced 
with  a highly  nonlinear  tracker  angular  rate  history.  It  was  concluded 
that  the  six  state  filter  is  a viable  alternative,  and,  with  some  proposed 
modifications,  is  preferable  (because  of  its  simplicity  and  lower  computa- 
tional burden)  and  warrants  further  study. 


vii 


HIGH  ACCURACY  AIRCRAFT  TO  SATELLITE  TRACKING: 
AN  EVALUATION  OF  TWO  PROPOSED  FILTER  MODELS 


I . Introduction 

Problem  Statement  and  Study  Objectives 

The  high  resolution  tracking  of  one  accelerating  vehicle  from  another 
(possibly)  accelerating  vehicle  has  many  military  applications  - aircraft 
to  aircraft  tracking,  aircraft  to  missile  tracking,  missile  to  aircraft 
tracking,  etc.  The  use  of  linear  or  nonlinear  system  analysis  techniques 
to  obtain  the  state  estimate  of  the  target  and/or  tracker  and  subsequent 
use  of  this  information  to  aid  the  tracking  device  is  well  documented  in 
the  literature  (see,  for  instance  Ref  1)  and  (Ref  2).  In  this  work,  the 
case  of  tracking  a satellite  from  an  aircraft  will  be  studied. 

The  purpose  of  this  study  is  to  develop  a reduced  order  system  model 
to  be  used  in  an  extended  Kalman  filter  to  aid  a typical  tracking  system. 
The  work  is  to  be  viewed  as  a feasibility  study  and  not  a complete  perform- 
ance analysis.  To  accomplish  this  end,  two  reduced  order  system  models 
will  be  studied  using  a covariance  analysis  as  an  evaluation  tool.  The 
reduced  order  system  model  must  be  of  low  enough  dimension  to  be  readily 
implemented  on  currently  available  digital  flight  computers  - on  the  order 
of  20  or  fewer  states  (Ref:  ). 

To  develop  and  evaluate  a reduced  order  system  model  using  a covar- 
iance analysis  computer  program  [supplied  by  the  U.  S.  Air  Force  Avionics 
Laboratory  (AFAL) ] , requires  that  the  following  general  objectives  be  met: 

1.  Develop  the  truth  model  representation  of  the  actual  system 
dynamics. 

2.  Generate  a tracking  profile  generation  program  to  provide  nominal 
data  for  an  aircraft  to  satellite  tracking  scenario. 
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3.  Develop  a reduced  order  system  model  - usually,  but  not  always, 
the  truth  model  with  certain  states  removed  or  combined. 


4.  Using  the  truth  model  and  the  nominal  tracking  profile,  perform 
a covariance  analysis  on  the  filter  based  upon  the  proposed 
reduced  order  system  model. 

5.  Adjust  the  filter  system  model  until  the  desired  performance  is 
obtained. 

The  objectives  of  this  study  are  somewhat  different  than  the  general 
guidelines  listed  above.  Originally,  the  work  of  Mitchell  (Ref  4)  was  to 
be  used  as  a baseline  for  the  evaluation  of  a new  reduced  order  system 
model.  However,  close  examination  of  his  study  revealed  several  serious 
errors  in  the  formulation  of  the  truth  model  and  in  the  generation  of  the 
nominal  tracking  profile.  With  this  in  mind,  the  first  objective  of  this 
study  then  became  to  reaccomplish  Mitchell's  work  by 

1.  Correcting  the  errors  in  the  truth  model. 

2.  Correcting  the  errors  found  in  the  profile  generation  program. 

3.  Reaccomplishing  the  evaluation  of  the  12  state  reduced  order 
filter  proposed  by  Mitchell. 

The  second  objective  of  this  study  remained  the  same:  to  develop 

and  evaluate  (against  the  same  corrected  truth  model)  a second  reduced 
order  (6  state)  system  model  proposed  by  Captain  (Dr.)  J.  Gary  Reid  of 
the  AFAL.  The  final  objective  is  to  compare  the  performance  of  the  two 
proposed  suboptimal  filters  and  to  make  recommendations  concerning  possible 
implementation  and  follow-on  work.  Because  of  the  time  limitations  in 
the  accomplishment  of  this  work,  and  the  inherent  limitations  in  applying 
a covariance  analysis  to  an  extended  Kalman  filter  (discussed  in  Chapter  IV), 
no  attempt  was  made  to  "tune"  either  reduced  order  filter  "perfectly"  to 
obtain  the  best  possible  performance.  This  philosophy  is  consistent  with 
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the  objective  of  performing  a feasibility  study  of  the  two  proposed 
filters.  Sufficient  tuning  will  be  accomplished  to  discern  differences 
in  performance  (if  any)  between  the  two  models. 


i 
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Assumptions  and  Limitations 

Because  the  system  dynamics  and  measurements  are  nonlinear  for  the 
aircraft  to  satellite  tracking  problem,  the  basic  linear  Kalman  filter 
formulation  cannot  be  applied  in  this  study.  Several  nonlinear  estima- 
tion techniques  are  available  to  handle  problems  of  this  type.  The  ex- 
tended Kalman  filter  formulation,  which  linearizes  the  state  equations 
about  the  most  recent  state  estimate,  was  chosen  because  of  its  simplicity 
and  low  computational  burden.  Inherent  in  the  application  of  an  extended 
Kalman  filter,  is  the  assumption  that  due  to  relinearizations,  a linear 
perturbation  model  driven  by  white  Gaussian  noise  in  an  additive  fashion 
is  adequate. 

For  a truly  linear  system,  the  results  of  a well  tuned  covariance 
analysis  depict  the  true  behavior  of  a proposed  filter.  For  a linear 
Kalman  filter,  the  covariance  propagation  is  not  dependent  on  the  measure- 
ments or  the  state  estimate.  Such  is  not  the  case  when  this  evaluation 
tool  is  used  with  an  extended  Kalman  filter.  Because  of  the  nature  of 
the  covariance  analysis,  the  state  estimate  is  not  propagated  and  is  un- 
available for  the  linearization  process  discussed  above.  Therefore,  the 
linearized  state  and  measurement  equations  are  evaluated  along  an  apriori 
nominal  trajectory  - the  nominal  tracking  profile  discussed  in  the  objec- 
tives section  of  this  chapter.  Thus,  an  inherent  limitation  of  applying 
a covariance  analysis  to  an  extended  Kalman  filter  is  that  the  apriori 
nominal  must  be  close  to  the  actual  state  estimate.  Otherwise,  what  might 
occur  is  that  a proposed  suboptimal  filter  may  perform  quite  well  in  a 
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covariance  analysis  and  quite  poorly  when  implemented.  For  the  above 
reasons,  the  results  of  a covariance  analysis  for  an  extended  Kalman  filter 
must  be  viewed  as  tentative  or  as  a small  perturbation  analysis.  One 
method  - usually  more  expensive  in  terms  of  computer  time  and  manhours  - 
for  obtaining  a better  indication  of  expected  filter  performance  is  to  per- 
form a Monte  Carlo  analysis  of  the  filter.  This  is  most  often  performed 
after  the  feasibility  of  a filter  design  has  been  shown  with  a covariance 
analysis. 

Due  to  time  limitations,  only  one  nominal  tracking  profile  was  employed 
in  this  study.  The  profile  which  was  used  represents  one  of  the  worst  case 
conditions  in  that,  at  the  beginning  of  the  simulation,  the  tracker  (air- 
craft) lies  in  the  orbit  plane  of  the  satellite  and  as  the  simulation 
progresses,  the  aircraft  moves  orthogonal  to  the  orbit  plane. 

Thus,  the  tracking  geometry  in  this  study  restricts  the  flow  of  "informa- 
tion" about  some  of  the  states  in  the  filter  and  observability  problems 
are  created. 

The  assumptions  made  concerning  the  instrumentation  of  the  aircraft/ 
tracker  system  are  as  follows: 

1.  Essentially  perfect  measurements  of  the  tracker  acceleration  with 
respect  to  inertial  space,  coordinatized  in  the  tracker  frame  are 
available  as  the  derived  (specific  force  minus  computed  gravity) 
output  from  three  accelerometers,  one  mounted  along  each  tracker 
axis. 

2.  The  tracking  system  will  provide  noise-corrupted  measurements  of 
the  inertial  angular  rates  of  the  tracker,  small  angle  deviations 
between  the  boresight  and  line-of-sight  frames  (discussed  in 
Chapter  II),  and  range.  It  is  also  assumed  that  the  system  has 


the  capability  of  instantaneous  correction  driven  by  the  state 
error  estimates  from  the  extended  Kalman  filter. 

3.  The  tracker  Y axis  will  be  inertially  stabilized  such  that  it 
always  lies  parallel  to  the  geocentric  equatorial  X-Y  plane 
(see  Figure  1,  Chapter  II). 

4.  The  second  proposed  reduced  order  system  model  (Filter  II)  requires 
that  an  inertial  navigation  system  be  on  board  the  aircraft  to 
provide  high  precision  (essentially  perfect  relative  to  other  errors 
inherent  in  the  problem)  measurements  of  the  inertial  position 
velocity  of  the  tracker  origin. 

5.  Essentially  perfect  measurements  of  the  tracker  elevation  and  azi- 
muth angles  will  be  available  from  resolvers. 
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II.  System  State  Equations 
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Introduction 

In  this  chapter,  the  satellite  (target)  and  tracker  state  and  measure- 
ment equations  will  be  developed  for  the  system  (truth)  model.  Because  the 
initial  part  of  this  study  is  a follow-on  to  the  work  of  Mitchell  (Ref  4), 
much  of  what  follows  in  this  chapter  parallels  his  developments.  One 
modification  to  his  truth  model  is  in  the  modeling  of  acceleration  measure- 
ments. The  system  state  equations  model  (as  accurately  as  desired)  the  true 
system  dynamics.  On  the  other  hand,  the  reduced  order  system  model  (filter) 
state  equations  are  implemented  using  the  best  information  available.  Thus, 
while  the  true  acceleration  of  the  tracker  with  respect  to  the  inertial  frame, 
coordinatized  in  the  tracker  frame,  is  used  in  the  truth  model,  the  filter 
model  obtains  this  information  from  accelerometers  mounted  on  the  tracker 
axes  (sensed  specific  force  minus  computed  gravitational  acceleration). 

I 

As  mentioned  in  the  Introduction,  an  assumption  of  this  study  is  that  the 
acceleration  information  received  by  the  filter  is  essentially  uncorrupted. 

This  assumption  negates  the  need  to  model  accelerometer  noises  in  the  truth 
model. 

Before  continuing,  a few  words  concerning  the  notation  adopted  in  this 
study  will  be  considered.  The  matrix  which  transforms  a vector  coordina- 
tized in  the  "i"  frame  into  a vector  coordinatized  in  the  "j"  frame  will 

A 

be  denoted  by  C^.  Unless  otherwise  indicated,  letter  superscripts  on 
vectors  will  indicate  coordinatization  in  the  frame  indicated  by  the 
superscript.  Where  it  is  necessary  to  address  individual  components  of 
vectors  coordinatized  in  specific  frames,  subscripts  will  be  used  to 
indicate  individual  components  i.e. 
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(2-1) 


I _ 


(A) 


I 


*x 

*Y 


The  superscript  "I"  indicates  that  the  vector  A is  expressed  in  the  inertial 
frame.  The  subscripts  X,  Y,  and  Z indicate  the  components  of  A along  the 
X,  Y,  and  Z axes  of  the  "I"  frame. 

The  remainder  of  this  chapter  will  cover  the  physical  description  of 
the  total  system  and  major  modeling  assumptions  made  in  this  study,  the 
development  of  the  satellite  and  tracker  state  equations,  and  the  system 
measurement  equations.  The  satellite  state  equations  will  not  be  formally 
derived,  as  the  approach  taken  is  straightforward  and  the  derivations  of 
the  models  of  individual  perturbative  effects  may  be  found  by  the  interested 
reader  in  any  good  astrodynamics  book  (see  for  instance  Ref  5) . On  the 
other  hand,  a complete  derivation  of  the  tracker  state  equations  will  be 
given,  as  they  reflect  the  modeling  assumptions  made  in  this  study. 

Configuration  of  System  and  Modeling  Assumptions 

Physically,  the  system  consists  of  a satellite  (target)  and  an  air- 
craft equipped  with  a radar  tracking  device.  The  radar  system  is  equipped 
with  three  rate  gyros  to  measure  the  three  components  of  the  tracker 
inertial  angular  velocity.  For  the  purposes  of  this  study,  it  is  assumed 
that  the  tracker  base  is  inertially  stabilized  such  that  the  tracker  Y 
axis  always  lies  parallel  to  the  inertial  X-Y  equatorial  plane  (see  Figure  1 
and  discussion  in  the  next  section).  In  addition,  it  is  assumed  that 
uncorrupted  tracker  inertial  position  and  velocity  information  is  avail- 
able from  an  inertial  navigation  system  (INS)  on  the  aircraft.  (This 
implies  that  the  aircraft  is  assumed  to  be  a rigid  body,  non-collocation 
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errors  are  negligible,  and  INS  errors  are  small  enough  to  be  neglected.) 

It  is  assumed  that  the  tracking  system  has  a control  loop  capable  of 
instantaneously  correcting  the  tracker  angular  velocities  according  to 
the  optimal  estimates  of  the  rate  errors  provided  by  the  extended  Kalman 
Filter.  Imperfect  measurements  of  the  range  to  the  target  and  the  small 
angular  deviations  between  the  tracker  boresight  and  the  true  line  of 
sight  will  also  be  available  from  the  radar  system. 

Satellite  State  Equations 

The  system  model  for  the  satellite  will  be  presented  in  this  section. 

The  dynamics  model  used  in  Mitchell's  earlier  work  was  designed  to  account 

-12  2 

for  all  accelerations  greater  than  10  Km/sec  (Ref  4:7).  Because  of 
limitations  in  the  standardized  computer  program  used  to  perform  this 
covariance  analysis,  the  solar  pressure  perturbative  acceleration  was 
deleted  from  the  system  model.  To  account  for  this  unmodeled  effect,  the 
strengths  of  the  driving  noises  on  the  satellite  state  equations  were 
increased  by  an  appropriate  amount. 

The  target  state  equations  are  expressed  in  the  geocentric  equatorial 
nonrotating  coordinate  system  with  the  X-axis  lying  along  the  line  of 
the  mean  vernal  equinox  (Figure  1) . This  coordinate  system  will  be 
considered  to  be  an  inertial  frame  for  this  application. 


Figure  1.  Inertial  and 
Rotating  (R)  Coordinate 
Systems 
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The  state  equations  describing  the  satellite's  motion  are 


X1  = X4 

x2  = x5 

X3  = X6 

X = A + A + A + A,  + W, 
4 R1  ml  S1  dl  1 


Xc  = A + A + A + Aj  + W. 
5 g2  m2  S2  d2  2 


X,  = A + A + A + Aj  + 

6 g3  m3  s2  d7  3 


(2-2) 


where 


X^,  X2,  X3  represent  the  target  inertial  position  components  along 

the  X,  Y,  Z axes  respectively 

X^ , X^,  Xg  represent  the  target  inertial  velocity 

A is  the  earth's  gravitational  acceleration  vector 
~g 

A is  the  lunar  gravitational  perturbation  vector 

Ag  is  the  solar  gravitational  perturbation  vector 

A^  is  the  atmospheric  drag  acceleration  vector 

W2»  W3  are  zero-mean  independent  white  Gaussian  noises  included 

to  account  for  unmodeled  effects  such  as  solar  pressure 

perturbations  and  higher  order  gravitational  terms,  and 

uncertainties  in  the  models  used  in  this  study,  such  as 

deviations  in  the  atmospheric  density. 

In  order  to  determine  the  strengths  of  the  white  noises,  consider 

the  following.  For  a relatively  small  satellite  - in  a 200  Km  circular, 

near  polar  orbit  - with  a solar  pressure  coefficient  equal  to  that  of  a 

2 

vehicle  with  a projected  surface  towards  the  sun  of  10m  and  a ballistic 


coefficient  of  1.5,  the  terms  of  X,  have  deterministic  values  of: 

4 
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1 


-3  2 

A = -7.55  x 10  Km/ sec  - acceleration  due  to  full  gravity 

S-i 

1 -10  2 

A = +5.0  x 10  Km/sec  - lunar  perturbative  acceleration 

ml 

-12  2 

A = +2.0  x 10  Km/sec  - solar  gravitational  perturbative 

S1 

acceleration 

-12  2 

A,  = -9.0  x 10  Km/sec  - drag  acceleration. 

1 

These  values  have  been  determined  using  the  models  proposed  later  in  this 

section  with  the  satellite  at  30°  north  latitude  and  the  sun  and  moon 

positioned  for  worst  case  effects.  The  unmodeled  solar  pressure  perturba- 

-12  2 

tion  or  the  satellite  under  these  assumptions  would  be  -2.0  x 10  Km/sec  . 

Because  of  the  aforementioned  criteria  of  modeling  all  perturbative 

-12  2 

accelerations  of  magnitude  greater  than  10  Km/sec  , a reasonable  value 

for  the  contribution  to  the  distribution  standard  deviation  of  due  to 

-12  2 

modeling  uncertainty  and  higher  order  effects  is  1 x 10  Km/sec  . Taking 

into  account  the  unmodeled  effects  due  to  the  solar  pressure  perturbations, 

Wr  W2,  and  are  modeled  a zero  mean  independent  white  Gaussian  noises 

-12  2 

with  distribution  one  a values  of  3 x 10  Km/sec  . 

Gravitational  Field  Modeling 

Modeling  of  the  earth's  gravitational  field  is  accomplished  in  a 
geocentric,  equatorial,  rotating  coordinate  frame.  The  relationship 
between  this  frame  RCX^,  Yr,  zr)  and  the  inertial  I(X,  Y,  Z)  coordinate 
frame  used  in  the  previous  section  is  shown  in  Figure  1.  The  transforma- 
tion matrix  from  the  rotating  (R)  to  the  inertial  (I)  frame  C*  is  defined 

R 

as 


c 


I 

R 


cos9  -sin0  0 

sin0  cos0  0 

0 0 1 


(2-3) 
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where 


0 = 0g  + u)  t 
e 


0 = local  sidereal  time  at  t = 0 

R 

u>  = earth’s  angular  rotation  rate  (7.292  x 10  ^ rad/sec) 
e 

t = time. 

The  potential  model  that  was  chosen  includes  tesseral,  zonal,  and 
sectorial  harmonics  up  to  and  including  (6,6)  (Ref  5:173-180). 

The  gravitational  potential  IKX^.Y^.Z^)  t*ie  R frame  is  (Ref  5,175) 


V = ^\l+  \ ( \ cos(mX  ) 

k=2Vm=o  k *k  1 k’m  E 


+ Sk>m  sin(mXE) 


(2-4) 


where  the  terms  in  Equation  (2-4)  are  defined  as  follows: 


y(sin<}>)  are  Legendre  functions: 

K T 


P^(sin<f>)  = (1  - sin<)>)m^  (P  (sin<J>H 

k d(sin^)m  k 


and  Pk(sin<f>)  is  the  Legendre  polynomial  with  argument  sin4>. 
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m is  the  mass  of  the  earth  (5.983  x 10  Kg) 

2 5 3 2 

k is  the  gravitational  constant  for  the  earth  (k  = 3.986  x 10  Km  / sec  ) 
e e 

r is  the  radial  distance  from  the  earth's  center  to  the  satellite 
4>  Is  the  geocentric  declination  angle  of  the  satellite 
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A is  the  longitude  of  the  satellite  with  respect  to  the  prime 
£ 


meridian. 

S,  and  C,  are  the  harmonic  coefficients  for  the  gravitational 
k,m  k,m 

potential  such  that  CR  Q and  Sk  0 = ^ and 

the  coefficients  are  the  zonal  harmonics, 

k 

C,  and  S,  are  termed  tesseral  harmonics  if  m ^ k,  m > 0 and 
k,m  k,m 

sectorial  harmonics  if  m = k (Ref  4:115-117). 

The  components  of  the  gravitational  acceleration  vector  along  the 


Xr,  Yr,  Zr  axes  - A , A , 


can  now  be  determined  by 


*R 


R 


JR 


<vRi 


A 

3U 

r\ 

\ 

3xr 

> 

09 

►-< 

d 

= 

8U 

3yr 

A 

3U 

A 

g7 

ZR 

3zr 

(2-5) 


and  the  gravitational  acceleration  vector  in  the  inertial  frame  can  be 
determined  from 


<V" ' C*(VR 


(2-6) 


Lunar  and  Solar  Perturbative  Accelerations 

The  perturbative  accelerations  on  the  satellite  due  to  the  lunar  and 
solar  gravitational  fields  will  be  discussed  in  this  section.  Because 
the  time  elapsed  during  a complete  tracking  pass  is  small  when  compared 
to  the  inertial  dynamics  of  the  moon  and  sun,  they  will  be  considered 
stationary  for  the  purposes  of  this  study. 
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The  lunar  perturbative  acceleration  vector  in  the  inertial  frame  is 
denoted  by  (a/,  with  the  components  along  the  inertial  X,  Y,  and  Z axes 
denoted  by  Am^,  An^,  and  Am^  respectively.  The  position  vector  of  the 
moon  in  the  inertial  frame  is  denoted  as 


(Rm)1 


Xm 

Ym 


Zm 


(2-7) 


The  position  vector  of  the  moon  relative  to  the  vehicle  is  denoted  by 


(R ms)  * 


(Rm) 1 


(Rs) 


I A 


Xm  - Xx 
Ym  - X2 
Zm  - X3 


and  the  perturbative  acceleration  on  the  vehicle  (satellite)  due  to  the 
moon's  gravitational  field  is 


(Am)1  = u(T 


Xm  - 

xi 

Xm 

3 

r 

ms 

3 

r 

m 

Ym  - 

X2 

Ym 

3 

r 

ms 

3 

r 

m 

Zm  - 

X3 

Zm 

3 

r 

ms 

3 

r 

m 

(2-8) 


where 

3 3 2 

ud  = gravitational  parameter  of  the  moon  ( 4.903  x 10  Km  /sec  ) 
Xms  = Xm  - X^ 
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Yms  = Ym  - X„ 


Zms  = Zm  - X. 


= (Xms  + Yms  + Zms) 1/2 


r = (Xm  + Ym  + Zm) 
m 


X^,  X2>  X^  = the  satellite  position  in  inertial  frame. 

In  an  entirely  analogous  manner  the  perturbative  acceleration  due  to 
the  sun's  gravitational  field  is 


(A  )T£  A 
—sun  s„ 


The  position  vector  of  the  sun  in  inertial  frame  is  defined  as 


(R  ) = Y 

—sun  sun 


and  the  perturbative  acceleration  on  the  vehicle  due  to  the  sun's 
gravitational  field  is 


X.  X 
1 sun 


(A  )T  = p© 
—sun 
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where 


113  2 

U®  = gravitational  parameter  of  the  sun  (1.327  x 10  ~ Km  /sec  ) 

x = X - x- 

ss  sun  1 

y = Y - x0 

ss  sun  2 

z = Z - x0 

ss  sun  3 

, 2 . 2 . 2 v 1/2 

r = (x  +y  + z ) 

ss  ss  ss  ss 


. 2 . 2 , 2.1/2 

r =(x  + y + z ) 

s s s s 


Acceleration  Due  to  Drag 

Drag  accelerations  on  the  satellite  are  modeled  as  a function  of 
the  height  above  the  earth's  surface,  the  velocity  of  the  satellite 
relative  to  the  rotating  atmosphere  and  the  vehicle  ballistic  coefficient: 


(Ad)1 


1 

2 


PB|VJ  (Va)T 


(2-12) 


where 


(Ad) 


drag  acceleration  vector  in  inertial  frame 


(V  )T  = 
—a 


x,  + id  x„ 
4 e 2 


xc  - o>  x, 
5 el 


velocity  of  satellite  relative  to  rotating 
atmosphere 


B = ballistic  coefficient  of  the  satellite 


-8h 


p = atmospheric  density,  modeled  as  p = p e 

. ° 

4 3 

p = mean  sea  level  atmospheric  density  (1.376229  Kg/Km  ) 


6 = altitude  atmospheric  density  decay  rate  (1.395  x 10  /Km) 
h 


222  1/2 

(x^  + *2  + xg)  - Rq  = height  above  mean  earth  radius 


Rq  = mean  earth  radius  (6.37817  x 10  Km) 


u>  = angular  rotation  rate  of  the  earth, 
e 
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»' 


I < 


i 

I 

i 
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While  the  ballistic  coefficient  of  the  vehicle  is  generally  not 
known,  it  is  known  that  for  a nonthrusting  vehicle  it  will  not  change 
significantly  during  the  time  of  a tracking  pass  (an  attitude  maneuver 
could  affect  it  by  changing  the  surface  area  along  the  velocity  vector). 

It  is  assumed  in  this  study  that  the  ballistic  coefficient  can  be 
adequately  modeled  as  a random  bias  (a  random  variable  that  has  100% 
correlation  in  time) 

B = 0 (2-13) 

with  an  initial  condition  as  a Gaussian  random  variable. 

Tracker  State  Equations 

While  the  target  state  equations  are  straightforward  and  represent 
a commonly  used  model  for  satellite  dynamics,  the  tracker  state  dynamics 
and  measurement  equations  are  very  dependent  upon  the  modeling  assump- 
tions made  in  this  study.  Therefore,  a full  development  of  the  tracker 
dynamic  state  equations  and  then  the  tracking  system  measurement  equa- 
tions will  be  given  in  this  section. 

The  geometry  of  the  tracker  is  shown  in  Figure  2. 


TARGET 


Figure  2. 


Tracker  and  Line-of-Sight  Geometry 
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It  is  assumed  that  the  tracker  base  is  inertially  stabilized  such 
that  the  tracker  elevation  axis,  YT>  always  lies  in  the  inertial  X-Y 
plane.  The  XT  axis  is  along  the  boresight  of  the  tracker  and  the  Z T 
axis  completes  a right-hand  orthogonal  system.  Assuming  that  the  tracker 
base  is  inertially  stabilized  as  above,  the  two  Euler  angle  rotations 
needed  to  go  from  the  inertial  to  the  tracker  frame  are  dependent  only 
upon  the  relative  position  vector  from  the  tracker  to  the  target,  ex- 
pressed in  inertial  coordinates.  The  first  Euler  angle  rotation  is  by 
an  angle  0 about  the  inertial  Z axis  as  shown  in  Figure  3. 

Z 

Y 

a 

Y 

X X 

a 

Figure  3.  First  Euler  Angle  Rotation 

The  subscript  "a"  indicates  an  intermediate  frame  and  the  transformation 
matrix  is 

l I 


(2-14) 
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XY  plane.  A planar  view  of  this  rotation  is  shown  in  Figure  4. 


f 


f 


z <=£  z 

a 


Figure  4.  Planar  View  of  Second  Euler  Angle  Rotation 


The  transformation  matrix  between  the  intermediate  "a"  frame  and  the 
tracker  "T"  frame  is 


a 


cos<j>  0 -sin<j> 

0 10 

sin<j>  0 cos(f> 


(2-15) 


Therefore,  the  Euler  angle  transformation  from  the  inertial  to  the  tracker 

T 

(T)  frame  is  given  by  as  is  shown  in  Figure  5. 


cos9cos<f> 

-sin0 

cos0sin<j> 


cosij>sin0  -sin<|> 

cos0  0 

sinc|>sin9  cos<t> 


(2-16) 


The  line-of-sight  (LS)  coordinate  frame,  though  not  directly  discernible 
to  the  user,  is  widely  used  in  pointing  and  tracking  problems.  The  LS 
and  T frames  have  the  same  origin;  however,  the  LS  frame  has  one  axis 
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Figure  5.  Inertial  and  Tracker  Frame  Orientations 

pointing  exactly  at  the  target  while  the  T frame  is  misaligned  from 

this  line-of-sight.  In  this  study  we  will  assume  that  the  LS  X-axis 

points  directly  at  the  target  as  was  shown  in  Figure  2.  For  perfect 

T LS  I 

tracking,  the  LS  and  T frames  are  aligned  i.e.  CT  = CT  . Let  (R„_) 

I I — bT 

denote  the  position  vector  of  the  satellite  with  respect  to  the  tracker 
expressed  in  the  inertial  frame: 


Coordinatizing  this  vector  in  the  LS  frame 


(2-17) 


(2-18) 


4 
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However,  by  definition  of  the  LS  frame  (R^*) 

bl 


where  R is  the 


_j  ls  X 

range  between  the  target  and  the  tracker.  Remembering  that  * C^. 

LS  T 

(for  perfect  tracking  = C^) 


R cos0cos<f>  sin0cosif>  -sin<}>  R^ 

0 : -sin0  cos0  0 Ry 

0 cos0sini)>  sin©sin<j>  cosij)  R 

_ L _ I *• . 


-R^sin©  + RyCos©  = 0 — = tan© 

X 


-l 

9 = tan  L(-L) 
®X 


-1 

6 = tan  — + it 
*X 


Quadrant 

Determination 


Also, 


Rxcos©sin<Ji  + RySin©sin<{>  + R^cosiJ)  = 0 
which  implies, aaf ter  some  algebraic  manipulation,  that 


tamji  = 


<£  + R^)1/2 


and  therefore 


<4  - R^)1/2 
<>!♦■?♦  ^>1/2 


Rz  < 0 


Rz  > 0 


Quadrant 

Determination 


For  the  suboptimal  filter  models  used  in  this  study  it  is  assumed 
that  the  angles  <P  and  9 will  be  obtained  directly  from  resolvers.  How- 
ever, the  relationships  derived  above  are  used  in  the  linearized  equa- 
tions used  for  the  extended  Kalman  Filter  formulation  and  in  generating 
simulated  resolver  data  in  the  covariance  analysis  of  the  proposed  sub- 
optimal  filters. 

In  practice,  perfect  tracking  in  which  the  tracker  X axis  aligns 
perfectly  with  the  LS  X axis  will  not  be  possible.  The  misalignment 
between  the  tracker  and  LS  frames  can  be  defined  in  terms  of  two  Euler 
angle  rotations.  In  a manner  entirely  similar  to  the  previous  deriva- 
tion, the  Euler  angle  rotations  are  fin  about  the  Z T axis  and  fie  about 
an  intermediate  (Y  = Y ) axis  as  shown  in  Figure  6 and. 

Si  Lu 


(2-23) 
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It  is  reasonable  to  assume  that  fie  and  fin  are  sufficiently  small  - even 


at  the  beginning  of  the  track  - to  use  the  small  angle  approximations 


sinfie  ' 6e 
cosfie  = 1 


sinfin  5 fin 
cosfin  s 1 


In  which  case.  Equation  (2-23)  becomes 

1 6n  -6e 

-fin  1 0 

fie  0 1 


(2-24) 


We  now  seek  relations  for  the  time  rate  of  change  of  fin  and  fie. 

The  cross  product  matrix  [u)T„]  for  writing  [<oT„]V  = wT  X V is  described 
in  terms  of  the  angular  velocity  of  the  LS  frame  with  respect  to  the 
inertial  frame  coordinatized  in  the  LS  frame  as  the  following  skew 
symmetric  form 


0 

““LSz 

"LSY 

0 

"““r 

“LSx 

0 

where  the  elements  of  the  matrix  represent  angular  velocities  about  the 
particular  axes  subscripted.  In  a similar  manner,  [oj^],  in  terms  of  the 
angular  velocity  of  the  T frame  with  respect  to  inertial  space  coordi- 
natized in  the  T frame  is 


1 


[wTl 


From  Broxmeyer's  work  we  know  that  (Ref  13:26-27) 


*Zs  " LSI  - [“T Ks 


LS 

Premultiplying  by  yields 


CTS£L  - ^ - CTSt“Xs 


where  - using  Equation  (2— 24 ) 


0 -fin  fie 

fin  0 0 

-fie  0 0 


Then 


cLScT 

T CLS 


finfin  + fiefie 

-fin 

fie 

= 

fin 

finfin 

-finfie 

-fie 

-finfie 

fiefie 

If  second  order  terms  are  neglected  then  Equation  (2-26)  becomes 


C 


LS*T 
c = 
T CLS 


0 

fin 


-fi'e 


-fin  fie 
0 0 

0 0 


(2-25) 


(2-26) 





A 


which  is  equal  to 


“ls-ct  Vis  ■ 

0 

“LSz 

—CO 

LSz 

0 

CO 

LSy 

~“LSx 

- 

1 

-6n 

6n 

1 

-5e 

0 

_ulsy 

CO 

LSx 

0 

<5e 

0 

1 

0 

CO 

i 

-6n 

6e 

co_. 

Tz 

0 

T 

Y 

-oom 

6n 

1 

0 

Tz 

-0J_ 

C0m 

T 

X 

0 

-6e 

0 

1 

ty 

L. 

T 

X 

■(u  +<5ew  -id  ) 

LZ  lx  Lbz 

■(id  -0)  +6n(0  ) 

L Y Y X 


((Dm  +6e<D_  -0L  _ ) 

Tz  Tx  LSz 
0 


■(<5no)  -<5ew  +<d  -id  ) 

TY  X Lbx 


("lsy-“ty+<"“tx> 

(6nooT  -6ew  +0)  -ID 
Y Z X 
0 


Using  the  above  equation  with  Equation  (2-26)  it  is  evident  that 


6q  = id  - (D  - 6eco_ 

Lbz  Lz  Lx 


6e  = ULSy  - WTy  + 6nUTx 


(2-27) 


“LSX  - % + *-ty  - j 


The  first  two  equations  of  Equations  (2-27)  describe  the  time  propagation 
of  the  error  misalignment  angles  6e  and  6n.  The  last  equation  in  (2-27) 
will  prove  useful  in  the  following  development  of  the  time  evolution  of 
the  line-of-sight  angular  velocity  vector 

In  order  to  determine  expressions  for  the  time  rate  of  change  of  the 
line-of-sight  angular  velocity  vector,  consider  the  position  vector  of 
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the  satellite  with  respect  to  the  aircraft  Rg?.  Differentiating  ^ST 
twice  with  respect  to  time  and  applying  Coriolis'  Theorem  each  time 
yields 


d%i 

dt2 


d2R 

dR 

do).  „ 

-^ST 

+ 2m  x “ST 

. -LS 

dt2 

+ 2^ls  x dt 

+ dt 

I 

LS 

LS 

X^ST 


LS 


+ — LS 


LS 


X^ST) 


(2-28) 


where  the  vertical  bar  indicates  the  frame  in  which  the  differentiation 
takes  place.  Coordinatizing  Equation  (2-28)  in  the  LS  frame  and  defining 
the  inertial  acceleration  of  the  satellite  relative  to  the  tracker  along 
the  line-of-sight  X,  Y,  and  Z axes  as 


reL 


rel. 


rel„ 


■ (A,./*  * Satellite*15  ' ^rackar’ 


LS 


and 


(r^t) 


LS  A 


d— ST 

— 

LS  ^ 

’ V 

r 

0 

dt 

LS 

0 

A . 

where  = R = range  rate 


the  following  is  obtained 
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A 1 
relx 

V 

r 

0 

0 

-r<“Ly  + “Lz> 

ArelY 

= 

0 

4-  2 

V U) 

r LS„ 

i- 

+ 

Ruls 

. z 

+ 

r“lsx\sy 

A i 

relZ 

0 

-V  wTC 
r LSy 

-Rulsy 

R“LSx“LSZ 

__  _ 

— 

— 

— 

- - 

(2-29) 


Examination  of  Equation  (2-29)  yields  the  following  scalar  state  equa- 
tions 


-\elz  2Vr"LSY 

X ' * * + "I-sx“lSZ 


(2-30) 


A . 2V  u 

relY  r LSZ 

ULSZ  r r “lsx“lsy 


(2-31) 


R = V 


(2-32) 


V = A , + R(wYC  + co?c  ) 

r relx  LSY  LSZ 


(2-33) 


Defining  (A  ) 1 as  the  inertial  acceleration  of  the  satellite  rela- 
tive to  the  tracker,  coordinatized  in  the  tracker  frame,  Equation  (2-24) 
can  be  used  to  obtain 


..  . LS  _LS  , . .T  „LS 

(Arei)  ■ S (A,)  - CT 


(2-34) 


thus,  it  follows  that 


A , = A + 6qA  - 6eA 

relX  rX  rY  rZ 


(2-35) 


26 


"1 


A , = A - 6qA 

relY  rY  rX 


(2-36) 


A , = A + 6eA 

relz  rz  rx 


Equations  (2-30,31,33)  now  become 


-A  - 6 eA  2V  io  _ 

rz  rx  r lsy 

WLSy  ' R " R + “LSXWLSY 


A - 6qA  -2V  co 

Jy fx  r Lsz 

“lsz  r r “lsx“lsy 


V = A + 6nA  - 6eA  + R(ol„  + ) 

r rx  ry  rz  LSy  LSZ 


(2-37) 


(2-38) 


(2-39) 


(2-40) 


Using  the  third  of  Equation  (2-27)  to  eliminate  io  from  Equations  (2-38,39) 

Lbx 

yields 

A 2V  to 

• rZ  r LSY  , -fie 

„ ^ = + (0T  „ um  + { A 


~LSy  R R 


LSz  Tx 


R r. 


+ (0  [6qu)  - <5eu  ]} 

LbZ  i TZ 


(2-41) 


-finA 


\SZ  ■ — - 2Vr“tSz  - “lsy“tx  + < 


k 


-to  [6nu  - 6eto  ]} 
L i Y TZ 


(2-42) 


The  bracketed  {•}  terms  in  Equations  (2-41,42)  represent  effects 
due  to  the  misalignment  between  the  tracker  and  LS  frames.  For  the  case 
of  perfect  tracking  (5e=6n=0)  these  terms  equal  zero. 
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Measurement  Equations 

The  tracking  system  has  the  capability  of  measuring  the  inertial 
angular  velocity  of  the  tracker,  the  two  angular  deviations  <5e  and  <$n, 
and  the  range  between  the  tracker  and  the  target.  The  models  used  in 
the  measurement  equations  are  developed  in  References  1,  6,  and  7. 

The  inertial  angular  velocity  of  the  tracker  is  measured  in  the 
tracker  coordinate  frame  by  three  rate  gyros,  one  mounted  along  each 
tracker  axis.  While  the  system  (truth)  model  propagates  the  true  line- 
of-sight  angular  velocities  ui^g  and  [Equations  (2-41,42)],  meas- 

urements are  available  only  in  the  tracker  frame  of  w , w , and  to  . 

TX  Y TZ 

Therefore,  measurements  of  a>_  and  oj  are  considered  by  the  filter  to 

TY  TZ 

be  pseudo-measurements  of  w^g  and  uj^g  ^ which  are  not  available.  The 
dominant  effects  which  contribute  to  errors  in  the  rate  gyro  measure- 
ments are  scale  factor  errors,  drift  errors,  g-sensitive  mass  unbalance 
errors,  misalignment  errors,  and  white  noise  (V^).  A suggested  gyro 
rate  measurement  model  (Ref  7:300)  is  given  as  (tracker  x-axis  only) 


= uu  + B , uu  + Z B A + C + [AC  w,,,  1 + V,  (2-43) 

Tr„  gsf x Trx  gmX  1 gX  gma-TrJX  1 


X 


where 


ox 


= measured  angular  velocity  along  XT  axis. 


= true  angular  velocity  along  X^,  axis. 
X 
B 


gsf 


= constant  bias  gyro  scale  factor. 


X 

B = coefficients  (along  X,  Y,  Z directions  in  tracker  frame) 

of  the  g-sensitive  mass  unbalance  to  which  the  gyro  is  subject. 

A = accelerations  (A,^  , A_  , A.J,  ) of  the  tracker  origin  with  respect 

X L\  Z 
to  inertial  space. 


gyro  drift  rate  along  XT  axis. 
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AC  = the  error  angle  transformation  matrix  resulting  from  the 
gma 

misalignments  of  the  three  gyros. 


0 

■B 

B 

A 

gma12 

gma13 

AC  = 

B 

0 

-B 

gma 

*“21 

gma23 

-B 

B 

0 

gma31 

girui  ^2 

— 

B 

gyro  misalignment  error  angles 

between  the 

desired  gyro 

8maij 

coordinates 

and  the 

actual  gyro  coordinates 

(mounting 

errors) , 


[ * ]i,  i = X.Y.Z 


i1"*1  component  of  the  vector  [ • ] 


= additive  zero  mean  white  Gaussian  noise  to  account  for  unmodeled 
effects  such  as  aniso-elastic  drift,  quantization  error,  etc. 


Because  it  shows  a certain  degree  of  time  correlation,  C , the  gyro 

8X 


drift  component  along  the  tracker  X-axis,  is  modeled  as  an  exponentially 
time-correlated  random  process. 

Suppose  that  the  gyro  in  question  has  been  studied  in  the  laboratory 
and  the  drift  along  the  X-axis  has  been  determined  to  have  a steady  state 
standard  deviation  of  a ^ radians  per  second,  with  a process  correlation 
time  of  seconds.  The  question  then  becomes  one  of  modeling  this  random 
variable  as  the  output  of  a linear  system  driven  by  white  Gaussian  noise. 
After  this  is  accomplished,  this  model  is  augmented  to  the  previously 
modeled  satellite  and  tracker  state  equations.  A zero-mean  exponentially 
time-correlated  Gaussian  random  process  of  variance  a ^ and  correlation 
time  can  be  modeled  as  the  output  of  a first  order  lag  with  lag 
parameter  8^  = 1/f^,  driven  by  a zero  mean  white  Gaussian  noise  of  unit 


strength,  as  shown  in  Figure  7: 


04 


Initial  Condition 


Figure  7.  Gyro  Drift  Modeling 


The  state  equation  for  C is 

8X 


C = -B/C  + /2fC  a. U. 
8V  4gv  4 4 4 


(2-44) 


The  autocorrelation  function  of  C is  the  desired  decreasing  exponential 


2 ' T ' 

E{C  (t)C  (t  + t)}  = cr.  e 

8x  8x  4 


(2-45) 


The  remaining  coefficients  in  the  rate  gyro  measurement  equation  are 
modeled  as  random  biases. 


Initial  Condition 

ii — 


^ x(t) 


Figure  8.  Random  Bias  Modeling 

By  using  this  model,  the  filter  is  "told"  that  the  value  of  the  variable 
does  not  change  in  time,  although  you  do  not  know  its  magnitude  apriori 
(Ref  3:204).  This  represents  a reasonable  model  for  the  remaining 
coefficients  because  while  they  may  not  be  constant  on  a long  term  basis, 
they  will  remain  essentially  constant  during  a ten  minute  tracking  pass. 


As  seen  from  Figure  8,  the  general  form  of  the  state  equation  for  these 
coefficients  is  X = 0.  The  equation  which  describes  the  way  the 
covariance  propagates  in  time  is 


P = 0 


(2-46) 


This  indicates  that  the  variance  of  the  coefficient  does  not  change  in 
time  and  that  the  initial  condition  on  P represents  the  variance  of  the 
coefficient  about  its  mean. 

The  measurements  of  the  tracker  angular  velocity  about  the  tracker 
Y and  Z axes  are  modeled  in  a manner  identical  to  iow  . The  values  used 

Mx 

for  the  standard  deviations  and  the  process  correlation  time  in  the  gyro 
rate  measurement  model  are  representative  of  a typical  aircraft  rate 
gyro  (Ref  7:302): 


Quantity 

Gyro  drift 

Gyro  scale  factors 

Gyro  mass  unbalance 
coefficients 

Gyro  misalignment 
coefficients 


Steady  State 
Standard  Deviation 

1 x 10  ^ rad/sec 
-4 

5 x 10 

3 x 10  ^ rad-sec/m 
-4 

1x10’ 


Process 

Correlation  Time 
3600  sec 

CO 

CO 


Additive  white 

Gaussian  noise  (V^) 


1 x 10 


rad/ sec 


0 


The  error  misalignment  angles  6e  and  6q  are  measured  in  the  tracking 
coordinate  frames.  Effects  which  can  degrade  these  measurements  are: 
deterministic  scale  factors,  scale  factor  errors,  angle  track  biases, 
and  angle  track  scintillation  noises.  No  attempt  has  been  made  to  model 
noises  that  are  specific  to  a typical  radar  or  laser  ranger.  Rather, 
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the  measurement  model  proposed  below  is  representative  of  a large  class 
of  measurement  devices  (Ref  6:14) 


StM  ‘ Kl(SeIr  + V + CSF  !£Tr  + BAT  + \ 

e z 


(2-47) 


- K2(«nTr  + S ) + CSF  6nIr  + »„  + V 

n n 


(2-48) 


where 

K^,K2  = deterministic  scale  factors. 

6e„  , 5n_  = true  misalignment  angles, 

ir  ir 

S ,S  = angle  track  scintillation  noises. 

e n 

Cci;i  ,C„_  = scale  factor  errors. 

or  br 

c n 

B = angle  track  biases. 

A 1 A 1 

e n 

V ,V  = zero  mean  white  Gaussian  noises  to  account  for  unmodeled 

4 5 

effects. 

Both  the  angle  track  scintillation  noises  and  the  scale  factor  errors 
are  modeled  as  exponentially  time  correlated  random  variables.  Scintilla- 
tion noise  is  dependent  upon  various  factors  such  as  atmospheric  propaga- 
tion, and  amplifier  characteristics  which  change  as  a function  of  time 
during  a typical  tracking  pass.  Scale  factor  errors  are  a function  of 
certain  tracker  variables  that  undergo  a change  with  respect  to  time 
(Ref  6:15).  Therefore,  in  a manner  similar  to  Equation  (2-44),  we  write 


S = -B.S  + /2B.  a.U. 
e 1 e 111 


S = -B.S  + /2b7  o,U„ 
n 2 n 2 2 2 


CSF  _67CSF  + /2s7  CT7U7 
e e 


(2-49) 


6SF  ■ -S8CSF  + ^ a8U8 

n n 
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Where  U, , U„,  U.,,  U0  are  zero  mean  white  Gaussian  noises  with  unit 
variance,  and  the  B's  and  a's  represent  the  inverse  of  the  process 
correlation  time  and  the  standard  deviation  of  the  process  respectively. 
The  angle  track  bias  coefficients  B and  B._  are  modeled  as  random 

A 1 A 1 

e - ti 

biases  - initial  value  unknown  but  describable  as  a Gaussian  random 
variable  with  mean  zero  and  a known  variance.  The  values  used  for  the 


process  standard  deviations  and  correlation  times  are  given  below.  For 
the  purposes  of  this  study  and  are  assumed  to  equal  one.  (Ref  4:149) 


Quantity 

Angle  track 

scintillations  (S  ,S  ) 

e q 

Angle  measurement 
scale  factor  errors 

^CSF  ,CSF  ^ 

e n 

Angle  track  bias 

(bat  ,bat  ) 
e n 

Additive  white  noise 


Steady  State 
Standard  Deviation 

1 x 10  ^ rad 


10 


2 x 10  ^ rad 


1 x 10  ^ rad 


Process 

Correlation  Time 
10  sec 


300  sec 


The  model  of  the  measurement  of  range  is  very  similar  to  those  of 
the  angular  deviations.  Uncertainties  in  the  measurement  of  range  are 
due  primarily  to  scintillation  noise  and  bias  errors. 


u 


"m  ■ V'rr  + V + BR  + V6 


(2-50) 


where 


= deterministic  scale  factor. 
SR 

RTr  = true  range. 


S = range  scintillation  noise 
K 


Br  = range  bias. 

V = zero  mean  white  Gaussian  noise  to  account  for  unmodeled  effects. 
6 


33 


The  range  scintillation  noise  is  due  to  atmospheric  effects  and 
errors  in  the  digitization  of  the  returned  signal.  The  atmospheric 
effects  in  particular  are  a direct  function  of  the  elevation  angle  of 
the  tracker  - less  scintillation  error  when  the  satellite  is  directly 
"overhead"  and  greater  errors  at  the  horizon.  The  scintillation  error 
will  show  a degree  of  time  correlation  during  a tracking  pass  and  an 
exponentially  time  correlated  random  variable  is  used  to  model  this 
state: 

' -®3SR  + ^ °3U3  <2-51) 


where  is  a zero  mean  white  Gaussian  noise  with  unit  variance,  and 
6^  and  are  the  inverse  of  the  process  correlation  time  and  its  standard 
deviation  respectively.  The  range  bias  is  modeled  as  a random  bias. 
(Initial  value  unknown,  but  describable  as  a zero  mean  Gaussian  random 
variable  and  known  variance.)  Values  used  for  the  standard  deviations 
and  correlation  times  are  shown  below  (Ref  4:150). 


Quantity 

Steady  State 
Standard  Deviation 

Process 

Correlation  Time 

Range  Scintillation 

.020  Km 

10 

sec 

Range  bias 

.005  Km 

00 

Additive  white  noise 

.005  Km 

0 

Summary  of  State  and  Measurement  Equations 


After  augmenting  the  satellite  and  tracker  state  equations  with  the 
noise  states  needed  to  define  the  measurements,  the  truth  model  contains 


a total  of  42  states.  They  are  repeated  here  for  clarity. 
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State  Equations 

(1)  \ = x4 


(2)  X2  = X5 


(3)  X3  = X6  / 


Satellite  Inertial  position 


(4)  X4  - 4gi  + A^  + ASi  + A^  + »! 


<5)  *5  ' V + + As-  + Ad-  + ” 


2 


Satellite  inertial  velocity 


2 2 2 2 


<6)  h - Ag3  + Am3  + As3  + Ad3  + W3  j 


(7)  a). 


-A  2V  u. 
rz  r lsy 


-6e 


LSy  R 


— + “LSZ“TX  + — \ + ^SZ 


[6nuT  - 6ew  ] f Tracker  angular  velocity 
TY  xz 


(8) 


A 2V  to  _ 
rY  r LSZ 


LSZ  R 


'-5nA. 

ULSyUTx  +\  R 


LS, 


[6nu  - 5ew  ] \ Tracker  angular  velocity 
TY  Z 


(9)  5n  = wTC  - w - 6ewT  Error  misalignment  angle 

LbZ  Z X 


(10)  6e  = uTC  - u + <5nw 

LbY  Y X 


(11)  R = Range 


Error  misalignment  angle 


2 2 

(12)  V = A + SnA  - 6eA  + R(w  e + w ) 
r rx  ry  rz  LhY  l&z 


Range  rate 
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(13)  = 0 Satellite  ballistic  coefficient 


(14)  S = -B,  S + /2B7  o.U. 

G I Z 111 


(15)  S = -8,S  + /2bT  o0U, 
n 2 n 222 


Angle  track  scintillation 


(16)  SR  = -B3Sr  + /2B^'  a3U3  Range  scintillation 


(17)  C = -B4C  + /2Z  a U 

gx  8X 


(18)  C = -BcC  + /2B,  acU 
gY  5 gv  5 5 5 


tt9>  % ’ ACtz  + /266  °6\ 


Gyro  drift 


(20)  CSF  =-B?Csf  +/2B7a?U7 

G G 


(21)  CSF  - -e8cSF  + ^2B8  o8u8 

n n 


Angle  measurement  scale  factors 


(22)  B =0 

gmx1 


Coefficients  of  gyro  mass  unbalance  (nine  equations) 


(30)  B = 0 / 


(31)  B =0 

gma12 


(32)  B =0 

x ' rrm  o 


Gyro  misalignment  coefficients 
(cont'd  on  next  page) 


(33)  B =0 

RTna01 


36 


(34)  B = 0 


(35)  Br 


(36)  B - 0 

£1^32 


(37)  b = 0 Range  bias 

R 


Gyro  misalignment  coefficients  (cont  d) 


(38)  Bat  = 0 


(39)  BAT  = ° 


MO)  B^-0 


Angle  track  bias 


(41)  B =0  y Gyro  scale  factors 


(42)  B 


0 J 


Measurement  Equations 


(li.  = m + B - to_  + Z B A . + C 

X Trx  gsfx  Trx  1=1  gmxt  1 gX 


+ [AC  (Dm  ]„  + V,  measurement  of  u>T 
gmar-Tr  X l Ly 


(2)  a)  = to  + B , u)_  + X B A.  + C 

\ Try  gsfy  Try  1 % 


+ [AC  co  ]„  + V_  measurement  of  u 
1 gma-Tr  Y 2 Jy 
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(3)  a)  = oj  + B , w_  + I B A + C 

Mz  Trz  gsfz  Trz  1=1  8mzi  1 8Z 


+ [AC  co_  ]„  + V_  measurement  of  io_ 
gma— 1 r Z i 1 _ 


where 


A1 = V, 


A2  = V 


A3  = V 


Acceleration  of  tracker  origin  in  tracker  coordinates 


(4)  + s ) + CgF  6nTr  + Bat  + V4  measurement  of  6n 

n n 


(5)  6eM  = K2(6eTr  + S£)  + Csp  6eTr  + BAT  + V5  measurement  of  5e 

e e 


(6)  = K^CR^  + SR)  + Br  + measurement  of  R 


Only  measurements  (2)  - (6)  above  correspond  to  measurements  of 

states  of  the  system.  There  is  no  state  equation  relating  the  motion 

of  the  tracker  about  the  line-of-sight  X-axis .because  angular  velocity 

about  the  line-of-sight  has  no  significance  for  purposes  of  tracking. 

Thus,  a)  is  not  measured  because  it  is  considered  to  be  a system 
X 

parameter. 


III.  Kalman  Filter  Formulation 


Introduction 

In  this  chapter,  the  propagation  and  update  equations  for  both  linear 
and  extended  Kalman  filtering  will  be  presented.  Listed  below  are  some  of 
the  definitions  used  in  this  chapter. 

X(t^)  = system  state  at  time  t^  (n-vector) 

X(t~)  = filter  estimate  prior  to  incorporating  a measurement  at 
time  t^  (n-vector) 

A + 

X(t^)  = filter  estimate  after  incorporating  a measurement  at  time  t^ 
(n-vector) 

$(t^+^,t^)  = state  transition  matrix  from  time  t^  to  time 

P(t^)  = filter  covariance  matrix  of  state  X(t^) , also  of  the  error 
in  the  estimate  of  X^) , prior  to  incorporating  a measure- 
ment at  time  t^  (nxn  matrix) 

P(t+)  = filter  covariance  matrix  of  state  X(t^) , also  of  the  error 
in  the  estimate  of  X(t^),  after  incorporating  a measurement 
at  time  t^  (nxn)  matrix 

F(t)  = system  dynamics  matrix  (nxn),  defined  for  all  time 

G(t)  = system  input  matrix  (nxs) , defined  for  all  time 
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w(t)  = system  dynamics  white  Gaussian  noise  s-vector,  independent 


of  X(tQ),  where  E[u(t)]  = £,  E[w/t)wT(T) ] = Q(t)6(t  - t). 


u^(t)  is  assumed  to  be  zero  mean,  Gaussian,  and  white 
(uncorrelated  in  time)  with  Q(t)  an  sxs  positive  semidef inite 
symmetric  matrix  that  is  in  general  piecewise  continuous  in  t. 


H(t^)  = system  observation  matrix  at  time  t^(mxn) 


R(t^)  = positive  definite  measurement  noise  covariance  matrix  (mxm) 


Z^(t^)  = m vector  of  measurements  at  time  t^ 


K(t^)  = Kalman  gain  matrix  (nxm)  defined  at  time  t^ 


v(ti) 


= zero  mean,  white  Gaussian,  measurement  noise  sequence 


independent  of  w(t)  and  X(t  ) for  all  time  (m  vector).  The 
— — o 


statistics  of  V(t^)  are  EfV(t^)]  = 0,  and 


E[V(t,)V(t.)]  = 


R(ti) 


Ci  = tj 


~ i ~ j 


otherwise 


Linear  Kalman  Filter  Formulation 


The  linear  Kalman  filter  formulation  presented  in  this  section  is 
for  a continuous  time  system  model  with  discrete  time  updates.  Assume 
that  the  system  modeling  has  been  completed  and  that  the  state  vector 
X(t)  satisfies  the  vector  stochastic  differential  equation 


X(t)  = F (t)X(t)  + G(t)w(t) 


(3-1) 


1 


AO 


mmmm 


The  state  equation  is  propagated  forward  in  time  from  the  initial  condi- 
tion X(t  ).  Since  the  exact  initial  condition  may  not  be  known,  it  is 
— o 

modeled  as  being  a Gaussian  random  variable  with  mean  X and  covariance 

— o 

P . 
o 


E[X(t  )]  = X , E{ [ X ( t ) — X ][X(t  ) - X ]T}  = P (3-2) 

— o — o — o — o — o — o o 

It  can  be  shown  (Ref  3:157-163)  that,  under  the  assumption  that  X(tQ) 
is  either  deterministic  or  a Gaussian  random  variable,  the  solution 
X(t)  to  linear  stochastic  differential  equations  such  as  Equation  (3-1) 
is  a Gauss-Markov  process,  i.e.  the  conditional  density  of  X at  time  t^ 
based  upon  all  realizations  of  X through  time  t^  ^ is  both  Gaussian  and 
completely  determined  by  the  process  value  at  t^_^.  Because  the  condi- 
tional density  is  Gaussian,  it  is  completely  specified  by  its  mean  and 
covariance  (Ref  8:92).  The  initial  covariance  matrix  Pq  may  be  positive 
semidef inite,  admitting  exact  knowledge  of  the  initial  conditions  of 
some  of  the  states. 

Measurements  are  available  at  discrete  time  points  and  are  assumed 
to  be  of  the  form  of  a linear  combination  of  the  states  and  corrupted 
by  a white  Gaussian  sequence  (Ref  9:2): 

Z(t±)  = H(ti)X(ti)  + V(tt)  (3-3) 

The  state  estimate  propagates  between  measurements  (from  time  t+_^ 
to  time  t~)  according  to 

X(t~)  = $(t1,ti_1)X(t^_1)  (3-4) 
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and  the  covariance  propagates  according  to 


P(t”)  = «,(t1»t1_1)p(t^_1)$T(t1,t1_1) 


+ / 1 $(t  ,T)G(x)Q(T)GT(T)$(t  ,T)Tdr 

ci-l  1 


(3-5) 


At  measurement  time  t^,  the  estimate  is  updated  according  to  (Ref  3:233) 


X(t1)  = X(t~)  + K(ti)[^1  - H(t1)X(t±)] 


(3-6) 


P(ti)  = P(t1)  - K(t1)H(ti)P(t1) 


(3-7) 


where 

K(t.)  = P(t^)HT(t1)[H(t1)P(t")HT(ti)  + R(ti)]"1  (3-8) 

where  [ ] X indicates  the  inverse  of  the  bracketted  matrix  and  C.  the 

~i 

realized  value  of  the  measurement  Z(t^)  at  time  t^. 

Under  the  assumption  that  the  adequate  system  model  is  linear,  and 

that  the  dynamic  driving  and  measurement  noises  are  Gaussian  and  white, 

* + 

the  Kalman  filter  provides  the  optimal  estimate  X(t.£)  of  the  state  of 

the  system  (Ref  3:66,214),  relative  to  many  optimality  criteria,  i.e. 

X(t+)  is  the  mean,  mode,  and  median  of  the  conditional  density  of  X(t£)> 

conditioned  on  the  entire  measurement  history  through  time  t^.  The 

A + 

covariance  of  the  error  committed  by  using  X(t^)  as  the  estimate  of  the 
state  at  time  t^  is  denoted  by  P(t+).  It  should  be  noted  that  for  a 
linear  estimation  problem,  the  covariance  propagation  [Equations  (3-5,7)], 
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1 

while  depending  on  R(t^),  is  independent  of  the  measurements  This 

will  no  longer  be  the  case  in  the  extended  Kalman  filter  formulation. 

The  assumption  that  the  system  can  be  modeled  as  being  driven  by 
white  Gaussian  noise  is  often  well  founded  on  two  accounts.  First,  it 
has  been  found  from  practical  experience  that  the  Gaussian  distribution 
provides  a reasonable  approximation  to  observed  random  behavior  in  certain 
physical  systems  (Ref  8:92).  Secondly,  the  central  limit  theorem 
(Ref  8:96)  states  that  if  the  random  phenomenon  that  we  observe  at  the 
macroscopic  level,  is  due  to  the  superposition  of  an  extremely  large 
number  of  independent  random  processes  on  the  microscopic  level,  then  the 
macroscopic  phenomenon  can  be  adequately  modeled  as  a Gaussian  random 
variable  (Ref  3:40). 

Extended  Kalman  Filter  Formulation  (Ref  9:179-189) 

The  extended  Kalman  Filter  formulation  is  commonly  used  in  estima- 
tion problems  in  which  the  adequate  state  and/or  measurement  equations 
are  nonlinear  rather  than  linear.  Consider,  as  before,  a system  that  is 
continuous  in  time  with  measurements  at  discrete  sampling  times.  Assume 
that  the  system  state  satisfies  the  following  nonlinear  vector  stochastic 
differential  equation 


X(t)  = f[X(t),t]  + G(t)a)(t)  (3-9) 

where  f(X, t)  is  a nonlinear  function  of  the  states  and  time  [in  general 

_f  could  also  be  a function  of  deterministic  control  inputs  u_(t)  ] , and 

the  vector  jo(t)  of  zero  mean  white  Gaussian  driving  noises  enters  in  a 

linear  additive  manner.  The  initial  condition  of  X(t  ) is  modeled  as  a 

— o 

Gaussian  random  variable  with  mean  and  covariance  P . Noise  corrupted 


J 
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vector  measurements  of  a (possibly)  nonlinear  function  of  the  states  and 


time  are  available  at  discrete  times  t^  as 


z(t±)  = h[x(ti),t1l  + V(t1) 


(3-10) 


where  V(t^)  is  a zero  mean  white  Gaussian  sequence  with  covariance  kernel 
(Ref  9:180). 


fmt.)  i = j 

E[V(t  )V(t  )]  = 1 

-1  ; 0 otherwise 


(3-11) 


To  better  understand  the  concepts  upon  which  the  extended  Kalman 
filter  is  based,  let's  first  look  at  the  derivation  of  a linearized  Kalman 
filter.  There  exists  a deterministic  nominal  trajectory  X (t)  such  that 


X(t)  = X + 6X(t) 

— — n — 


(3-12) 


where  6X(t)  represents  the  perturbation  of  the  state  from  the  nominal  and 
X (t)  satisfies 


k = £[X  (t) , t] ; 


X (t  ) = X 
—no  — n 


(3-13) 


and  X represents  the  initial  condition  of  the  state  on  the  nominal 
o 

trajectory  X(tQ).  Associated  with  the  nominal  trajectory  is  a set  of 
deterministic  measurements  at  t^. 


From  Equations  (3-9,12,13)  it  is  evident  that 


[X(t)  - X^(t)]  = f[X(t),t]  - f[X^(t),t]  + G(t)u(t) 


(3-15) 


The  variational  equation,  which  is  a first  order  approximation  to 
Equation  (3-15),  is  found  by  expanding  Equation  (3-15)  in  a Taylor  series 
about  the  nominal  trajectory  and  neglecting  all  but  first  order  terms 
(Ref  8:58). 


6X(t)  = F[t;X  (t)]6X(t)  + G(t)u>(t) 


(3-16) 


where  F[t;X  (t) ] is  the  matrix  of  partial  derivatives  of  f with  respect 
— — n 

to  X evaluated  along  the  nominal  trajectory  X (t) 


F[t;X  (t)]  = 


3f [X  (t) , t] 


(3-17) 


X(t)  = X (t) 


Note  that  is  dependent  upon  X because  it  is  evaluated  along  X^(t). 

o 

In  an  entirely  similar  manner,  the  linearized  measurement  equation  for 
the  error  in  the  measurement  at  time  t^  is  developed  in  the  following 
equations 


Z(t.)  = Z (t.)  + 6Z(t.) 
— I n i — l 


(3-18) 


then  from  Equations  (3-10,14) 


[Z(tt)  - Zn(t±)]  = h[X(ti),t1]  - h[Xn(t1),t1]  + V(tt)  (3-19) 
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and 


6Z(t1)  = H[t1,X(t1)]6X(ti)  + V(t1) 


(3-20) 


where  Hft^.XCt^)]  is  the  matrix  of  partial  derivatives  of  h with  respect 

to  X evaluated  along  the  nominal  trajectory  X (t.)  (Ref  9:182). 

— — ■ n 1 


3h[X(t  ),t .] 

Hltj.XCtj)]  s 


x(tj) 


(3-21) 


As  long  as  the  partial  derivative  matrices  H and  E exist,  one  can 
apply  linear  filtering  theory  to  the  linearized  perturbation  equations. 
Equations  (3-16,20).  However,  it  must  be  kept  in  mind  that  this  linearized 
system  of  equations  is  only  valid  for  small  perturbations  about  the  nominal 
trajectory  (Ref  8:59).  A rule  of  thumb  which  is  often  applied  in  defining 
"small"  perturbations  is  that  there  be  approximately  an  order  of  magnitude 
difference  between  the  first  and  second  terms  in  the  Taylor  series  expan- 
sions which  led  to  Equations  (3-16,20)  (Ref  9:183).  If  the  nonlinearities 
are  too  pronounced,  a higher  order  filter  incorporating  more  terms  in  the 
Taylor  series  and  using  higher  moments  of  X(t)  may  be  applied  (Ref  8:190- 
192). 

In  the  extended  Kalman  filter  formulation,  the  validity  of  the 

assumption  that  deviations  from  the  nominal  trajectory  are  "small"  is 

A + 

maintained  by  relinearizing  about  the  trajectory  emanating  from  X(t^) 
once  it  has  been  computed  (Ref  9:183-184).  After  relinearizing  about 
this  new  "nominal" 
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6X(tp  = 0 


(3-22) 


Letting  6X(t  t.)  = the  estimate  of  6X(t)  at  time  t,  t,  < t < t.,,,  based 
i i — i+1 

upon  the  realizations  4.  of  measurements  Z(t.),  through  time  t,,  the 

—1  — i i 

optimal  estimate  of  the  state  error  [6X(t|t^)]  propagates  forward  in 
time  according  to 


6X(t| t±)  = F[t;Xn(t,t.)]6X(t|t1) 


(3-23) 


subject  to  the  initial  condition 


SXftJti)  = 6X(t±)  = 0 


(3-24) 


where  F(t;X  (tit.)]  = the  relinearized  evaluation  of  F,  where  X (tit.) 

n 1 — — n i 

is  the  solution  to  the  deterministic  differential  equation,  X^tlt^)  = 
^[X^t | t^) , t]  propagated  from  the  new  initial  condition  of  X(t^).  Thus, 
the  solution  to  Equation  (3-23)  is  ^X(t|t^)  = ()  over  the  entire  interval 
[ti’ti+i)’  anc*  = 1 t^)  = 0.  (Ref  9:185).  This  follows  from 

the  fact  that  Equation  (3-23)  is  linear. 

From  Equations  (3-6,16),  the  linearized  system  is  updated  at  meas- 
urement time  t^+^  according  to 


«X(t1+1)  = «X(ti+1)  + K(t1+1)[5ll+1  - H(t1+1)6X(t"+1)] 


I ' 


Kfti+l^J^l+l  ^ r'fti+l^~i+l  Li^  ’ Ci+l^  (3-25) 


L 


Matrices  evaluated  along  the  most  recent  nominal  trajectory  X^tlt^)  are 
used  to  compute  the  Kalman  filter  gains  K(t^+^,). 
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We  now  combine  these  results  to  achieve  the  final  extended  Kalman 


filter  algorithm.  Because  ^X(t|t^)  = 0 over  the  interval  from  t^  to  t^+^ 
the  best  estimate  of  X(t)  over  this  interval  is  the  solution  to  (Ref  9:185) 


x(t|ti)  = f[X(t|ti),t] 


(3-26) 


with  initial  condition 


^(tJV  " i(tj)  (3-27) 

At  the  next  update  time,  t^+^,  from  Equation  (3-12) 


-(ti+l)  ^n(ti+l) 


(3-28) 


and  the  estimate  of  6X(t^+^)  is  given  by 

«k(tj+1>  = -i(t1+1|t1)  (3-29) 

where  X(t^+^ | t^)  is  the  solution  to  Equation  (3-26)  integrated  forward 
from  the  initial  condition  of  X(t+) . Using  the  fact  that  the  update  for 
the  state  perturbation  is  given  by  Equation  (3-25),  the  update  equation 
for  the  state  estimate  at  time  t^+^  is  given  by  (Ref  9:186) 

X(t*+1)  = X(ti+1|t1)  + K(t1+1)[i1+1  - h[X(t1+1|t1),ti+1]]  (3-30) 

The  covariance  is  propagated  between  t+  and  t^+^  by  integrating 
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+ G(t)Q(t)G  (t) 


(3-31) 


from  the  initial  conditions 


x<ti|ti)  = i(tj),  p (ti I t±)  £ p(t^) 


and  is  updated  according  to 


P(ti+1>  P^ti+1^  “ K^ti+l^-fti+l’-^ti+l^P^ti+l^ 


(3-32) 


where 


K(t^^)  P(t^+1)H  [t^+1 ,3C(t<+1 ) ] (H[t^+1  ,X(t^+1 ) ]P  (t^+1 ) 


i+l'“  lfci+l’^'fci+l,J  l“lfci+l»^','i+l/J‘  ^i+l' 


HT[t1+1,X(t“+1)]  + R(t1+1)}'1 


(3-33) 


Note  that  the  Kalman  gains  and  covariance  propagation  are  no  longer 
independent  of  the  state  estimate  - and  thus  of  the  measurements  - as 
they  were  in  the  linear  estimator. 

The  next  chapter  of  this  study  will  present  the  development' of  a 
covariance  analysis  as  a method  for  evaluating  tjje'-'performance  of  a 
reduced  order  filter.  In  a covariance-analysis,  the  covariances  of  the 
filter  and  truth  model^areTJr’opagated  without  generating  the  actual 
filter  estimat£--lfCt) . However,  as  shown  previously,  the  covariance 
prpp«gation  in  an  extended  Kalman  filter  is  dependent  upon  the  state 
estimate  through  the  partial  derivative  matrices  F and  H.  An  approximate 


covariance  analysis  can  be  accomplished  by  linearizing  instead  along  a 
nominal  reference  trajectory  5^(0,  i-e*  Z.  anc*  H are  evaluated  using 
X^(t)  (Ref  9:186).  Because  a covariance  analysis  is  viewed  as  a first 
step  (to  be  followed  by  a Monte  Carlo  analysis)  in  determining  the  feasi- 
bility of  a filter  for  a linear  system  model,  it  is  of  utmost  importance 
that  the  results  obtained  using  a linearized  system  model  be  viewed  as 
tentative  because  deviations  between  5^(0  ancl  X(t|t^)  may  lead  t0  a 
significant  degradation  in  actual  performance. 

A covariance  analysis  costs  much  less  in  time  and  money  than  a 
Monte  Carlo  analysis  and,  in  light  of  the  above  discussion,  it  still 
represents  a viable  first  step  in  the  analysis  of  a proposed  extended 
Kalman  filter  design.  It  is  to  be  viewed  as  a small  scale  analysis, 
assuming  deviations  from  the  a priori  nominal  are  small  - 
)C(t|t^)  - 2^(t).  The  partial  derivative  matrices  and  H [Equations 
(3-16,20)]  for  the  system  model  developed  in  Chapter  II  are  described 
in  Appendix  A. 


IV.  Covariance  Analysis  of  a_  Reduced  Order  Filter  Model 


In  Chapter  II  the  truth  (system)  model  state  and  measurement  equations 
were  developed  for  the  satellite  tracker.  The  term  "truth"  model,  though 
widely  used  in  the  literature,  is  slightly  misleading  in  that  it  implies 
that  the  true  system  dynamics  and  measurements  are  exactly  modeled.  This 
is^  of  course,  incorrect  in  that  there  is  no  way  of  predicting  exactly  what 
the  actual  system  performance  will  be.  Rather,  the  42-state  "truth"  model 
is  an  attempt  to  account  for  the  dominant  system  disturbances.  When  the 
speed  and  memory  capabilities  of  airborne  computer  systems  are  examined, 
it  becomes  readily  apparent  that  it  would  not  be  possible  to  implement  the 
filter  based  upon  this  truth  model.  Therefore,  as  in  most  Kalman  filter 
applications,  suboptimal  (reduced  order)  filter  models  are  proposed  to 
perform  the  task  within  the  existing  hardware  and  software  capabilities. 
Several  such  designs  are  proposed  in  Chapter  V.  The  obvious  question 
becomes,  how  do  you  evaluate  a suboptimal  filter  design?  One  widely  used 
method  is  the  covariance  analysis.  A covariance  analysis  provides  a 
direct  comparison  between  the  covariance  of  the  errors  committed  by  the 
reduced  order  filter  and  the  filter  based  on  the  truth  model  for  a linear 
system.  It  also  provides  a comparison  for  the  errors  that  the  filter 
commits  and  the  errors  it  "thinks"  it  commits. 

However,  a covariance  analysis  is  viewed  as  only  a first  step  in 
the  evaluation  of  a proposed  filter  design.  While  the  covariance  equa- 
tions provide  RMS  filter  performance  data  directly,  they  do  not  represent 
a system  simulation  (Ref  3:361).  Once  the  covariance  analysis  has  proven 
the  feasibility  of  the  filter  design,  a Monte  Carlo  simulation  is  usually 
performed  which  uses  the  filter  mechanization  equations  to  process 
simulated  data.  While  a Monte  Carlo  analysis  is  a better  indicator  of 
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expected  filter  performance,  it  is  more  costly  in  terms  of  time  and 
money • 

Covariance  Analysis  Equations 

In  this  section,  the  covariance  analysis  equations  will  be  briefly 
presented.  The  error  states  will  be  formulated  by  subtracting  value  of 
the  optimal  estimate  of  states  in  the  filter  from  the  values  of  these 
same  states  as  provided  by  the  truth  model.  A new  state  vector  will 
then  be  formed  by  augmenting  this  error  state  vector  with  the  suboptimal 
filter  state  vector.  The  result  will  be  in  the  form  of  a linear  system 
driven  by  white  Caussian  noise  and  will  allow  us  to  apply  linear  analysis 
techniques  to  the  augmented  system  to  determine  the  covariance  propaga- 
tion and  update  equations  for  the  augmented  state.  In  practice,  the 
estimates  from  the  filter  would  be  used  in  a closed  loop  control  system. 

To  simplify  the  developments  presented  here,  control  inputs  will  not  be 
considered.  The  developments  are  based  extensively  on  several  reports 
prepared  by  Air  Force  Avionics  Laboratory  personnel  (Ref  10,11). 

Consider  the  truth  model  equations  to  be  of  the  form 

i (t)  = F (t)X  (t)  + G (t)u  (t)  (4-1) 

— s s — s s — s 

where 

X is  an  n,  state  vector  for  the  truth  model 

— s 1 

Fg  is  an  n^xn^  system  dynamics  matrix 

G is  an  n,xs,  gain  matrix 
s 11 

u)^  is  an  s.  vector  of  zero  mean  white  Gaussian  noise  inputs 

T 

with  variance  E[M^(t)ui^(x)  1 = (1^6  (t  ~ t). 

Equation  (4-1)  is  considered  to  represent  the  linearized  error  state  equa- 
tion - Equation  (3-16)  - for  the  truth  model. 
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Consider  also  a reduced  order  filter  model  that  satisfies  the 


following  state  equation 

Xf(t)  = FjX^t)  + Gf(t)wf(t)  (4-2) 

where 

2^  is  an  n2  vector  denoting  the  filtei  state  (n2  < ^ in  general) 

Ff  is  an  n2xn2  filter  dynamics  matrix 
is  an  n2xs2  gain  matrix 

co_  is  an  s„  vector  of  zero  mean  white  Gaussian  noise  inputs  with 
— f 2 

variance  E[o)^(t)w^(t)  ] = 0^6(t  - t). 

System  and  filter  model  measurements  will  be  considered  to  be  avail- 
able as  discrete  time  sequences  corrupted  by  zero  mean  white  Gaussian 
noise  sequences.  For  the  system,  measurements  are  modeled  as 

w ■ WW  + W <4‘3) 

where 

Z (t.)  is  an  m vector  of  discrete  time  measurements 
— s i 

H (t.)  is  an  mxn,  system  measurement  matrix 
si  1 

V (t.)  is  an  m vector  of  zero  mean  white  Gaussian  noise  sequences 
— s i 

with  variance  EfV^t^V^Ct^)  ] = R^t^S^ 

The  filter's  model  for  these  same  measurements  is 


^(t^)  = Hf  (t±)X.f  (t±)  + Vf(t1) 


(4-4) 


where 


Z,(t.)  is  an  m vector  of  discrete  time  measurements 
— f i 
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Hj-(t^)  is  an  mx^  filter  measurement  matrix 

V,(t.)  is  an  m vector  of  zero  mean  white  Gaussian  noise  sequences 
— r i 

with  variance  E[ V- (t  )vl(t  ) ] = Rc6., 

— t i — t 1 t i] 

Because  the  covariance  analysis  equations  are  only  applicable  to  a linear 
system,  Equation  (4-4)  is  replaced  by  Equation  (3-20),  the  linearized 
measurement  error  equation  for  the  filter.  The  filter  state  estimate 
and  covariance  (X^,P^)  are  propagated  and  updated  according  to  Equations 
(3-4)  to  (3-8),  with  the  exception  that  the  filter  state  estimate  uses 
the  realizations  of  the  measurements  provided  by  the  system  model  - 

W 

X^t*)  ■ ifCtj)  + Kf(t1)[Js(t1)  - (4-5) 

In  order  to  develop  the  equations  relating  the  statistical  behavior 
of  the  actual  error,  the  following  definition  of  the  actual  c jtimation 
error  is  made  (Ref  10:16).  The  error  ei(t)  is  defined  as  an  n^  vector 
expressing  the  error  committed  by  using  a particular  filter  and  is 
evaluated  as 

e(t)  £ X (t)  - TXf(t)  (4-6) 

— — s — t 


where 


with 

I_  = ^x^  identity  matrix 
0 = (n^-n2)xn2  null  matrix 
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What  Equation  (4-6)  implies,  of  course,  is  that  the  first  ^ states 
of  the  system  model  are  identical  to  the  entire  set  of  states  in  the 
filter.  In  practice,  the  filter  model  is  usually  the  truth  model  with 
selected  states  removed.  If  this  is  not  the  case,  T may  be  appropriately 
redefined  without  changing  the  final  results  (Ref  4:56). 

The  objective  of  the  covariance  analysis  is  to  examine  the  time 
propagation  of  the  covariance  of  £(t) 

Pee(t)  = E[e(t)eT(t)] 


Defining  the  augmented  state  vector  ]f(t)  as 


Y(t)  = 


e(t) 

Xf(t) 


(4-7) 


then  it  can  be  shown  that  Y(t)  satisfies  the  following  stochastic  diff- 
erential equation 


Y(t)  = F (t)Y (t)  + G(t)u  (t) 

C 


(4-8) 


where 


F(t)  = 


F (t) 
s 

0 


F (t)T  - TF.(t) 
s t 

Ff(t) 


and  the  second  moment  propagates  according  to 
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P(t)  = F(t)P(t)  + P (t)r  (t)  + G(t)Qs(t)G(t) 


where 


P (t)  P17(t) 

P(t)  £ 66  12 

P21(t)  Pf(t) 


The  augmented  state  vector  Y(t)  is  updated  at  a measurement  according  to 
(Ref  10:18) 


+ e(t+)  I - TKf(t1)Hs(t1)  TKf(ti)[Hf(t1)  - H^t^T] 

1 Xf(t+)  VVW  I + VVW1  - Kf(t1)Hf(t.) 


e(t.)  -TH  (t  ) 

. 1 + f V (t  ) 

Xf(t±)  Kf(ti) 


(4-10) 


Y(t±)  = A(t1)Y(ti)  + B(ti)Vg(ti) 


and  the  covariance  is  updated  according  to 


P(t+)  = A(t1)P(t^)AT(ti)  + B(ti)Rg(ti)BT(ti) 


(4-11) 


As  stated  before,  the  state  equations  for  both  truth  and  filter  models 


must  be  linear  before  a covariance  analysis  can  be  performed.  This  is 
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accomplished  by  linearizing  about  a nominal  trajectory.  The  usefulness 
of  the  results  of  the  analysis  depend  upon  the  validity  of  assumption 
of  linearity.  To  preserve  this  assumption,  it  is  important  to  keep  the 
interval  between  measurements  small  with  respect  to  system  time  constants, 
and  to  keep  the  perturbations  small  about  the  assumed  nominal  trajectory. 
Effects  of  violating  these  conditions  can  be  evaluated  only  through  a 
subsequent  Monte  Carlo  analysis. 


V.  Reduced  Order  Filter  Models 


Introduction 

The  purpose  of  this  chapter  is  to  develop  the  two  reduced  order  sys- 
tem models  for  which  covariance  analyses  were  performed  in  this  study. 

In  all  cases,  the  reduced  order  system  model  should  be  computationally 
simpler  than  the  truth  model,  as  this  is  usually  the  criterion  which  pre- 
vents the  implementation  of  the  filter  based  upon  the  truth  model.  How 
this  simplif ication  takes  place  is  due  to  the  decisions,  skill,  prior 
experience,  etc.  of  the  designer.  In  many  cases,  simplification  is 
accomplished  by  deleting  states  from  the  truth  model  that  represent  non- 
dominant effects  in  the  problem  under  study.  Typically,  this  is  accom- 
plished with  a corresponding  increase  in  strengths  of  noises  driving 
the  system  to  account  for  the  neglected  effects.  For  instance,  while 
neglecting  gyro  drift  rates  as  sources  of  error  in  a navigation  filter 
may  significantly  degrade  performance  of  the  filter,  the  deletion  of 
these  states  may  not  be  deleterious  in  a tracking  problem  of  ten  minutes 
of  duration.  In  addition  to  the  deletion  of  states,  another  technique 
that  is  used  is  to  delete  terms  in  the  state  equations  that  are  less 
than  a third  or  a quarter  of  the  size  of  the  other  terms  in  the  expression, 
i.e.  in  addition  to  deleting  nondominant  states,  we  also  delete  nondominant 
terms  in  the  remaining  state  equations.  Careful  judgment  must  be  exercised 
in  this  latter  case  because  these  small  cross  coupling  terms  may  be 
extremely  important  in  meeting  certain  performance  criteria  for  the  system. 

The  first  reduced  order  filter  (hereafter  referred  to  as  Filter  I) 
model  represents  a simplification  to  the  truth  model  based  upon  the  two 
criteria  discussed  above  - deletion  of  states  and  nondominant  terms.  The 
second  reduced  order  filter  (Filter  II)  was  suggested  by  the  Air  Force 


Avionics  Laboratory  specifically  for  this  study.  The  main  thrust  of 
this  filter  is  to  use  what  is  known  about  the  dominant  dynamical  modes 
of  the  vehicle  being  tracked  to  aid  in  the  simplification  of  the  truth 
model. 

Filter  I State  Equation  Development 

The  truth  model  developed  in  Chapter  II  has  42  states.  The  first 
12  of  these  states  model  the  satellite  and  tracker  dynamics.  State  13 
was  included  to  model  the  effect  of  atmospheric  drag  and  the  remainder 
of  the  states  were  included  to  model  uncertainties  in  the  measuring 
devices  for  angular  tracking  rates,  tracker  angular  deviations  from  the 
line-of-sight  and  range. 

Consider  first  the  simplication  of  the  first  six  of  the  state 
equations.  They  are  repeated  below  for  convenience 

= X4  (5-1) 

X2  = X5  (5-2) 

X3  = X6  (5-3) 

(5-4) 

(5-5) 

(5-6) 

where 


X = A + A + A + A,  + W, 
4 81  ml  S1  dl  1 


X = A + A + A + A.  + W. 
5 g2  ^2  d ^ ^ 


X,  = A + A + A + A.  + W, 
6 g3  m^  s3  d3  3 
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A^  = acceleration  due  to  full  gravity 


A = perturbative  acceleration  due  to  the  moon's  gravitational  field 


A = perturbative  acceleration  due  to  the  sun's  gravitational  field 


A^  = acceleration  due  to  atmospheric  drag 


W = zero  mean  white  Gaussian  driving  noise,  with  variance 
E{W  (t)W  (t)}  = (3  x 10-12  Km/sec2)2  6 (t  - t) 


As  can  be  seen  by  the  data  presented  on  page  10  of  this  study,  the 

dominant  effect  is  that  of  the  earth's  gravitational  field.  The  two 

_g 

body  point  mass  acceleration  accounts  for  all  but  (-2.0  x 10  Km/sec) 

_ C O 

of  the  effect  (-7.55  x 10  Km/sec  ) due  to  full  gravity  (Ref  4:66). 
Therefore,  the  filter  model  chosen  for  the  satellite  dynamics  is  the 
basic  two  body  point  mass  acceleration  model.  While  this  model  would 
certainly  be  a poor  choice  for  long  tracking  passes  (long  in  the  sense 
that  the  pass  represents  a significant  portion  of  the  orbital  period), 
it  is  a reasonable  model  for  the  profile  under  test  for  which  the  typical 
tracking  pass  represents  only  l/20th  of  the  orbital  period.  The  increase 
in  uncertainty  due  to  the  reduced  accuracy  in  the  dynamics  model  is 

i 

accounted  for  by  increasing  the  strengths  of  the  driving  noises  W^, 

W2,  and  W^.  Thus,  the  following  relations  are  obtained: 


X1  = X4 


(5-7) 


x2  = x5 


(5-8) 
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u®  = the  earth's  gravitational  constant 


/ 2 2 2 

rv  “ ’'X^  + X2  + X3  is  t*le  distance  from  the  earth's  center  to  the 
satellite 


and  Wj,  W2,  W3  were  initially  assigned  one  sigma  values  of  2 x 10-9  Km/sec, 
based  upon  the  above  analysis  of  the  size  of  the  unmodeled  acceleration 


terms. 


Consider  now  the  tracker  angular  velocity  state  equations 


-A  2V  wTP 

• rZ  r LSY  /ic 

"LS?  - — - * + “lsz“tx  + «-r  Arx 


+ w [<5nw  - 6ew  ]} 

LSZ  TY  TZ 


(5-13) 


A 2V  ioT  _ 

rY  r LSZ  _x  — 

“LSZ  - — - R - “LSYUTX  + {1T  Arx 


- a)  [6n<o  - 6 eio  ]} 

lsy  ty  TZ 


(5-14) 


61 


The  bracketted  terms  {•}  result  from  the  fact  that  the  tracker  and  line- 
of-sight  frames  are  not  coincident  and  differ  by  the  two  small  Euler 
angles  6e  and  Sri-  For  high  accuracy  tracking,  the  small  angular  devia- 
tions 6n  and  <5e  will  have  magnitudes  on  the  order  of  10  ^ radians  or 

less  (Ref  3:67).  For  the  particular  tracking  profile  used  in  this  study, 

-11  2 

the  bracketted  terms  are  on  the  order  of  10  radians/sec  while  the 

• • . 2 

smallest  values  of  uT „ and  w c are  =10  radians/sec  . Thus,  in  the 

L i LbZ 

reduced  order  filter  model  the  bracketted  terms  are  neglected  and  replaced 
by  a zero  mean  white  Gaussian  driving  noise  to  account  for  the  increased 
uncertainty  in  the  dynamics  model: 


-A 


2V 


LS, 


“LSY  + ^z\  + W* 


(5-15) 


LS„ 


2V 

~R~  “LSZ  " ULSyUTx  + W5 


(5-16) 


Initially,  before  the  covariance  analysis  was  tuned  to  give  the  best 

-11  2 

performance,  and  were  assigned  one-sigma  values  of  10  radians/sec  , 
based  upon  the  values  of  the  bracketted  terms  that  were  dropped. 

The  remaining  state  equations  are: 


«n  - »LSz  - y*  - Sty* 


(5-17) 


6e  - (0T_  - w + 6nw 

LbY  TY  TX 


(5-18) 


R = V 


(5-19) 


V = A + 6nA  - 6eA  + R(o)2  + u)2  ) 

r rX  rY  rZ  LSY  LSZ 


(5-20) 
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Equation  (5-20)  may  be  simplified  using  the  same  criteria  as  for 

Equations  (5-13,14).  For  high  accuracy  tracking,  the  terms  containing — - 

6'n  and  5c  will"  be  approximately  five  orders  of  magnitude  smaller  than 
V . Therefore,  in  the  proposed  filter  model,  these  two  terms  are  dropped 
and  replaced  by  a zero  mean  white  Gaussian  driving  noise  (W^)  of  strength 
equal  to  (1  x 10  Km/sec  ') : 


V 

r 


) + w6 


(5-21) 


Filter  _I  Measurement  Equation  Development 

The  measurement  equations  for  the  truth  model  are  summarized  at  the 
end  of  Chapter  II  on  page  37.  In  each  case,  the  measurement  is  considered 
to  be  the  sum  of  the  state  which  is  a realization  of  one  stochastic 
process,  and  the  noises  are  realizations  or  samples  of  other  stochastic 
processes  by  our  model.  For  instance,  consider  the  measurement  of  the 
inertial  angular  velocity  of  the  tracker  along  the  tracker  Y axis 


% 


Tr. 


+ B 


gsfv  Tr 


3 

E B A + 
gut,  i 

i=l  i 


'“gmAr'Y  + 


V.  (5-22) 


A T 

where  t.  = [ to  to  w ] represents  the  true  angular  velocity  of  the 

Tr  Trx  lry  lrz 

tracker  coordinatized  in  the  tracker  frame  (it  should  be  recalled  that 
and  ui^  are  considered  to  be  pseudomeasurements  of  the  line-of-sight 


angular  velocities  wT  and  to  which  are  not  directly  measurable) . 

L Y LbZ 

The  second  through  fifth  terms  in  Equation  (5-22)  are  stochastic  models 
of  the  dominant  noise  processes  that  corrupt  a rate  gyro  measurement. 
The  last  term,  V is  a zero  mean  white  Gaussian  noise  sequence  added 
to  account  for  errors  in  the  modeling  assumptions  and  unmodeled  higher 


order  effects.  B , , B , B , B and  the  elements  of  the  matrix 
gsfy’  gm^  gny  gmy 

AC  are  all  modeled  as  random  biases,  i.e.  X(t)  = 0.  For  lack  of 
gma 

better  information  they  are  modeled  as  zero  mean  with  a variance  deter- 
mined from  experimental  evidence.  Each  of  these  stochastic  processes  is 
then  multiplied  times  a deterministic  quantity  - the  resulting  product 
in  each  case  being  a random  process,  at  a given  time  is  modelable 

as  a sample  value  at  that  time  from  a stochastic  process.  The  inertial 
acceleration  of  the  tracker  origin  in  tracker  coordinates 


V 

AT 

T 

(V  = 

A2 

= 

X 

Y 

A3 

is  assumed  to  be  a deterministic  system  parameter  in  this  study  for  both 

Filter  I and  II.  Note  that  both  filters  would  require  "ownship" 

accelerations  in  order  to  determine  the  relative  acceleration  in  the 

tracker  frame.  The  component  of  the  gyro  drift  along  the  tracker  Y 

axis,  C , is  modeled  as  an  exponentially  time-correlated  random  process. 
gY 

In  the  filter  measurement  model,  it  is  assumed  that  the  total  effect  of 
all  of  the  corruptive  effects  in  each  of  the  truth  model  measurement 
equations  can  be  replaced  by  a single  zero-mean  white  Gaussian  noise 
sequence.  The  filter  measurement  model,  for  each  state,  consists  of 
the  "true  value"  plus  an  additive  white  noise  to  account  for  modeling 
uncertainties.  For  the  state  we  chose  as  an  example, 


+ V„ 


(5-23) 
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a. 


This  approach  to  modeling  the  measurements  leads  to  the  simplest  filter 
implementation.  If  the  performance  should  prove  to  be  poor  using  this 


model,  the  variance  of  could  be  increased  to  indicate  additional 
uncertainty  in  the  assumed  measurement  model.  If  performance  remains 
poor,  this  would  be  an  indication  that  some  of  the  effects  appearing  in 
the  truth  model  measurement  equations  must  be  added  - at  the  expense 
of  a higher  dimensioned  filter  - to  the  filter  measurement  equations. 


Summary  of  Filter  State  and  Measurement  Equations 

The  state  and  measurement  equations  for  the  Filter  I reduced  order 
system  model  are  summarized  below.  The  development  of  the  linearized 
dynamics  and  measurement  matrices  F and  E for  Filter  I is  given  in 
Appendix  B. 


State  Equations 


(i)  xx  = x4 


(2)  X2  = X5 


O)  x3  = x6 


(4)  x4  “ — r + wi 

r 

v 


(5)  X5  = T * W2 

r 

v 


<6)  X6 r + “3 

r 

v 
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-\z  2Vlsy 

(7)  “LSy  ■ -5 — * “lsz“tx  + W4 


Ar  2Vr“l.S 

m “LSZ  ' ~5 - “LSY%  + W5 


(9)  fin  = w - u>_  - Sew 

LbZ  Z X 


(10)  fie  = uLS  - o)T  + finwT 
Y Y X 


(ID  R - V 


(12)  Vr  - * »2Sz> 


Measurement  Equations 


(1>  * ”TrY  + V1 


(2)  ' »Trz  + V2 


(3)  fin  = fin.fr  + v3 


(4)  fie  = fieTr  + V4 


(5)  R = RTr 


The  original  (untuned)  one  sigma  of  the  measurement  noises  are: 


1 
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Noise 

V, 


One  Sigma  Value 


5.0 

X 

ID"6 

rad/sec 

5.0 

X 

lO"6 

rad/ sec 

2.5 

X 

IQ"6 

rad 

2.5 

X 

lO"6 

rad 

2.2 

X 

lO'2 

Km 

Filter  II  State  Equation  Development 

The  underlying  concept  for  the  development  of  the  filter  model  pro- 
posed in  this  section  is  to  delete  the  satellite  inertial  position  and 
velocity  states  [X(l)  ->  X (6) ] . Other  information  already  available  in 

the  remaining  six  states  and  INS  data  will  then  be  used  to  determine  the 

T 

acceleration  of  the  satellite  relative  to  the  tracker  (A  ) based  upon 
the  knowledge  that  the  dominant  acceleration  of  the  satellite  can  be 
described  by  a two  body  point  mass  gravity  model.  This  approach  to  the 
satellite  tracking  problem  was  suggested  for  inclusion  in  this  study  by 
U.  S.  Air  Force  Avionics  Laboratory  personnel. 

Figure  9 represents  a typical  tracker  line-of-sight-satellite 
geometry. 

TRACKER 

1 ORIGIN  ZT„ 


SATELLITE 


EARTH  CENTER 


Figure  9.  Typical  Tracker  Line-of-Sight-Satellite  Geometry 
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r 


where 


(X,Y,Z)  is  the  geocentric  equatorial  inertial  frame 

is  the  tracker  line-of-sight  frame,  with  X^g  pointing 
at  the  satellite 


is  the  vector  from  the  center  of  the  earth  to  the  tracker 


I*  is  the  vector  from  the  center  of  the  earth  to  the  satellite 

b 


R^_  is  the  vector  from  the  origin  of  the  tracker  system  to  the 
— Si 


satellite  along  the  line-of-sight  X axis 


K 


When  the  satellite  inertial  position  and  velocity  states  are  deleted 
from  the  Filter  I model,  the  following  information  remains  available  to 
formulate  a new  filter  model: 

0,(f>  - precise  resolver  measurements  of  the  tracker  azimuth  and 

elevation  angles. 

LS 

C " (0 , <J>)  - the  transformation  matrix  from  the  inertial  to  the  line- 

of-sight  frames  as  a function  of  0 and  <t>. 

T 

(A,j,)  - high  precision  measurements  of  the  tracker  acceleration 

with  respect  to  inertial  space  in  tracker  coordinates,  deter- 
mined from  the  outputs  of  three  accelerometers  - one  mounted 
along  each  of  the  tracker  axes. 

~ no^se  corrupted  measurements  of  range,  tracker 
angular  rates,  and  angular  deviations  as  dis- 
cussed in  Chapter  II. 
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The  formulation  of  the  state  equations  for  Filter  II  is  different 

from  Filter  I in  that  filter  estimates  of  the  satellite  inertial  position 

T 

are  no  longer  available  to  calculate  ( A - the  inertial  acceleration 

of  the  satellite  with  respect  to  the  tracker  in  the  tracker  frame.  The 
T 

components  of  (A^)  along  the  tracker  X,  Y,  and  Z axes  are  used  by  the 
filter  in  estimating  the  tracker  angular  rates  and  the  range  rate  per 
Equations  (2-40,41,42).  As  in  the  Filter  I formulation,  terms  containing 
6e  and  5q,  in  these  equations  are  neglected  to  yield 


2Vls, 
\ 

R 


+ »j,Sz»Tx  + ”4 


(5-24) 


2Vls„ 


R 


“ls  “t  + 

Y TX 


W„ 


(5-25) 


V 

r 


+ r(w: 


LS, 


) 


(5-26) 


Consider  the  following  development  of  the  acceleration  of  the  satellite 

LS 

with  respect  to  the  tracker  (A^.  ) expressed  in  the  line-of-sight  frame. 

From  Figure 


(Rg)1  = (V1  + C1ST)I  (5-27) 

where  the  superscript  "I"  again  indicates  coordinatization  in  the  inertial 

frame.  From  the  definition  of  the  line-of-sight  (LS)  frame  (the  line-of- 

sight  X axis  - X^s  - points  exactly  at  the  target),  we  know  that  the  posi- 

LS 

tion  vector  of  the  satellite  relative  to  the  tracker  (IL,-)  lies  along 

— O 1 

^S 
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<«st)LS=  0 


where  R is  the  range  between  the  tracker  origin  and  the  satellite.  It 
follows  that 


^-ST^  CLS^ST^ 


(5-28) 


From  Equation  (5-27)  is  is  seen  that  the  inertial  acceleration  of  the 
satellite  with  respect  to  the  tracker  expressed  in  inertial  coordinates 
(^t)1  Is 


(isx)1  - y1  - (y1 


(5-29) 


Elementary  astrodynamics  tells  us  that  we  can  model  the  inertial 

acceleration  of  the  satellite  (R.,)1  as 

— b 


..  t -vattg) 
(O  = “Y'o 

^ I (VI 


and  Equation  (5-29)  becomes 


" I " I 

(^ST}  = , /T1  x I, 3 " (V 


where  from  Equations  (5-27,28) 


®s>T  - y1  + clLS(hr)LS 


(5-30) 


(5-31) 


70 


It  is  evident  at  this  point  that  if  the  tracker  inertial  position 


(R.J,)  were  made  available  from  an  INS  on  the  aircraft,  then  the  accelera- 
tion of  the  satellite  relative  to  the  tracker  expressed  in  LS  coordinates 


. LS 


[ which  is  (A^  ] can  be  found  by 


<Ae/S  k «st>LS  - - CIS 


UV1!3 


(Rp) 


CLS^ST^ 


It  3 


-uaC^C^)1  + 


(RgT) 


LS 


(Rs) 


1 1 3 


(5-32) 


Under  out  assumption  that  6e  and  6n  are  small,  the  tracker  and  line-of- 
sight  frames  are  nearly  aligned.  It  follows  that  the  acceleration  vector 
of  the  satellite  relative  to  the  tracker  coordinatized  in  the  tracker 

Also,  the  acceleration 


T LS 

frame  - (A^)  - is  well  approximated  by  (A^  p) 


of  the  tracker  with  respect  to  inertial  space  expressed  in  the  LS  frame  - 
" LS 

(Rp)  - is  well  approximated  by  the  inertial  acceleration  of  the  tracker 

..  ip 

in  the  tracker  frame  (Rp)  which  is  derived  from  the  outputs  of  the 
accelerometers.  Equation  (5-32)  can  now  be  expressed  as 


(A  ) 


,cis (y1  + ^t>l3  (^)T 


(Rs) 


1 1 3 


(5-33) 


Equation  (5-33)  is  readily  implementable  as  all  parameters  in  it  are 


available: 


C is  a known  function  of  the  resolver  angles  $ and  0 


(R^) 1 is  provided  by  the 


(Rsx) 


0 where  R is  the  range 


(Rjj.)  is  derived  from  the  output  of  the  accelerometers 


(y1  - <yT  + c ^s(rsi)ls 


Therefore,  for  Filter  II,  the  form  of  the  state  equations  for  ui  , 

Y 

wLS  , and  Vr  remain  as  given  in  Equations  (5-24,25,26)  with  the  components 

Z T 
of  (A  ) 1 


(A  )T  = A. 


determined  by  the  corresponding  components  of  Equation  (5-33) . 


Filter  II  Measurement  Equations 


The  measurement  equations  for  Filter  II  remain  the  same  as  for 


Filter  I. 


VI.  Results  and  Discussion 


Introduction 


The  purpose  of  this  chapter  is  to  present  the  results  of  the  covariance 
analysis  performed  on  the  Filter  I and  II  models,  and  subsequently  to  dis- 
cuss and  interpret  these  results.  Special  emphasis  will  be  given  to  expected 
actual  filter  performance.  Prior  to  presenting  the  results,  the  tracking 
profile  used  in  the  covariance  analysis  and  the  philosophy  used  to  tune  the 
filters  will  be  discussed,  since  they  have  a direct  bearing  on  the  perform- 
ance achieved  in  the  study. 

At  the  initialization  of  the  tracking  profile,  the  aircraf t/tracker 
lies  on  the  Greenwich  meridian  at  a geocentric  latitude  of  30°  north.  For 
the  duration  of  the  200  second  tracking  pass,  the  tracker  moves  at  a constant 
speed  of  0.3  Km/sec  eastward  while  maintaining  the  same  geocentric  latitude. 

The  satellite  is  in  a 200  Km  circular,  near  polar  orbit,  and  it  is  a relatively 
small  vehicle  with  a ballistic  coefficient  of  1.5  and  a solar  pressure  co- 
efficient equal  to  that  of  a vehicle  with  a projected  surface  area  towards 
2 

the  sun  of  10m  . Initially,  the  satellite  lies  essentially  on  the  prime 
meridian  and  is  approaching  a descending  node  (descending  towards  the  equator), 
as  shown  in  Figure  10. 

Initial  Subpoint  of 
Satellite 

Initial  Location 
of  Tracker 


30°  N 


Equator 


Pr~me  Meridian 


Figure  10.  Satellite/Tracker  Geometry 
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Pertinent  tracking  information  for  the  profile  used  in  this  study  is  sum- 
marized below.  The  angles  9 and  <p , which  define  the  coordinate  transforma- 
tion from  the  inertial  to  the  line-of-sight  frame  (see  Chapter  II),  may  also 
be  used  to  describe  the  tracker  azimuth  and  elevation  angles  - (-<(>)  being  the 
elevation  angle  and  9 the  azimuth  angle  (0°  azimuth  being  defined  as  the 


condition  in  which 

the  x^s  axis  is  parallel  to  the  inertial  X axis) . 

Parameter 

Initial  Value  (t  = 0) 

Final  Value  (t  = 200  secs) 

Elevation  angle  of 

56.5° 

74.7° 

tracker  (-<f>) 

Azimuth  angle  of 

180.0° 

222.1° 

tracker  (0) 

“lsy 

-9.58  x 10  ^ rad/sec 

-18.91  x 10  3 rad/sec 

2.57  x 10  ^ rad/sec 

55.9  x 10  rad/sec 

The  time  history  of  w and  w are  given 

Lbv 

in  Figures  11  and  12.  Note 

that  both  curves  are  nonlinear  with  to  being  especially  so.  This  is  to  be 


expected  from  the  geometry  of  this  tracking  profile.  As  the  track  progresses, 

the  tracker  moves  in  a plane  perpendicular  to  the  orbit  plane  of  the  satellite. 

Therefore,  it  is  expected  that  the  inertial  angular  velocity  about  the  line- 

of-sight  Y axis  - the  elevation  axis  of  the  tracker  - -to  would  first 

Lby 

accelerate  and  then  slow  down  as  the  satellite  approaches  its  zenith  with 

respect  to  the  tracker.  On  the  other  hand,  the  time  rate  of  change  of  the 

tracker  azimuth  angle  - w - is  expected  to  continually  accelerate  until 

LSZ 

the  satellite  is  coplanar  with  the  tracker  - an  azimuth  angle  of  270°. 

Thus,  while  the  tracking  profile  used  was  not  representative  of  worst  case 
conditions,  it  does  present  a highly  nonlinear  angular  rate  history  with 
which  to  evaluate  each  filter's  estimation  capability. 

Briefly  stated,  for  a fiJter  to  be  well  "tuned"  through  a covariance 
,n.t  "sii,  the  filter  error  variance  should  follow  the  "true"  system  error 
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variance  as  closely  as  possible  without  underestimating  it.  Typically, 


t 


[ 


! 


this  results  in  the  generation  of  the  lowest  possible  system  error  variances. 
This  is  accomplished  by  varying  the  strengths  of  the  state  dynamics  and 
measurement  noises  in  the  filter  until  the  desired  "tuning"  is  achieved. 

By  using  constant  noises  in  an  extended  Kalman  filter,  we  are  faced  with 
the  possibility  of  divergence,  in  which  the  error  variance  of  a filter  state 
approaches  steady  state  while  the  error  variance  of  the  system 

ps(t)  = pee(t)  - E{[Xg(t)  - TXf(t)][Xs(t)  - TXp (t) ]T> 

grows  without  bound.  This  happens  because  the  filter  is  weighting  its 
internal  model  too  heavily.  This  is  what  Jazwinski  has  termed  "learning 
the  wrong  state  too  well"  (Ref  14:301-302).  Such  divergence  character- 
istics can  be  remedied  to  some  extent  by  admitting  time  varying  (such  as 
piecewise-constant)  noise  strengths  in  the  model  upon  which  the  filter 
is  based.  However,  as  mentioned  before,  the  scope  of  this  study  was 
confined  to  achieving  adequate  tracking  performance  over  a reasonable 
time  interval  with  the  use  of  a single  set  of  noise  strengths.  Decreased 
dynamic  noise  strengths  would  allow  a "tighter"  tuning  during  the  initial 
period  while  increased  strengths  would  remove  (or  at  least  postpone)  the 
onset  of  divergence.  In  eventual  implementation,  time-varying  strengths, 
possibly  set  adaptively  since  their  "best"  evaluation  would  be  trajectory 
dependent,  could  enhance  filter  performance  (Ref  9:155). 

Filter  I Results 

This  section  will  present  the  results  of  the  covariance  analysis 
performed  on  Filter  I.  They  should  be  considered  as  representative  of 
the  filter's  capabilities  but  not  final.  Further  tuning  may  be  possible 
and  should  be  performed  if  specific  limits  of  the  capability  of  the 
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filter  are  under  question.  Moreover,  a Monte  Carlo  analysis  would  be 

required  to  evaluate  large  scale  filter  performance. 

The  one  sigma  values  for  the  errors  committed  by  the  filter  in  the 

estimation  of  the  satellite  inertial  position  and  velocity  (states  X^  -*■  X^) 

are  plotted  in  Figures  13-24.  Each  of  the  satellite  inertial  position 

states  exhibited  an  initial  upward  transient  followed  by  a period  in  which 

the  error  variance  decreased.  This  very  slow  transient  response  was  due 

to  the  weak  coupling  between  the  satellite  and  tracker  state  equations  (no 

direct  measurements  of  any  of  the  satellite  states  were  available  in  this 

formulation).  The  error  plots  for  the  satellite  inertial  velocity  states 

(Figures  19-24)  show  a steadily  decreasing  error  for  all  states. 

Figures  25  and  26  are  the  plots  for  the  standard  deviation  of  the 

errors  in  the  estimates  of  w c and  cjt  _ . The  errors  committed  by  the 

LbY  L Z 

filter  and  the  system  are  given  on  the  same  plot  so  as  to  facilitate 
comparison.  The  filter’s  inability  to  follow  the  system  closely  when 
time- invariant  noises  are  employed  is  evident  in  Figure  25.  However, 
this  plot  does  indicate  that  the  filter  can  provide  a conservative  esti- 
mate (the  filter  overestimates  its  own  errors)  of  wTC  in  spite  of  the 

L i 

nonlinear  nature  of  the  w time  history.  The  filter  performed  nearly 

lsy 

as  well  over  the  tracking  period  in  estimating  the  error  in  its  own 

w estimate,  again  performing  as  a conservative  estimator.  Note,  how- 
LSZ 

ever,  that  divergence  between  the  filter  and  system  is  very  evident  for 

the  last  50  seconds  of  the  track.  Though  the  filter's  estimate  of  the 

error  is  slowly  increasing,  it  is  placing  too  much  emphasis  on  its 

internal  dynamics  model  and  is  not  able  to  follow  the  highly  nonlinear 

behavior  of  coT „ towards  the  end  of  the  tracking  profile.  As  shown  in 
L°Z 

Figures  27-30,  the  filter  follows  the  system  very  well  for  the  error 
misalignment  angles,  range  and  range  rate  states.  Divergence  in  the 
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estimate  of  <5n  can  be  seen  near  the  end  of  the  track.  This  is  directly 
attributable  to  the  coupling  between  6n  and  w „ (the  estimate  of  which 

Lbz 

is  diverging  at  the  end  of  the  track)  in  the  state  equation 


(6-1) 
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Figure  13.  Filter  I,  Filter  Error  Standard  Deviation  - State  X, 
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Figure  30.  Filter  I,  Error  Standard  Deviation  of  Range  Rate  Estimate 
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Filter  II  Results 

Plots  of  the  standard  deviation  of  the  error  estimates  for  the  six 
state  Filter  II  model  are  shown  in  Figures  31-36.  The  filter  was  unable 
to  follow  the  system  for  the  total  tracking  profile  for  any  state.  Con- 
sequei  ly,  it  was  decided  to  tune  the  filter  to  provide  the  best  possible 
performance  over  the  first  100  seconds  of  the  tracking  pass.  The  "best 
possible  performance"  is  defined  here  as  minimizing  the  area  between  the 


filter  and  system  curves  while  insuring  that  the  filter  doesn't  under- 
estimate its  own  errors.  These  plots  represent  a fairly  well  tuned  filter 
in  that  every  attempt  by  the  author  to  force  the  filter  to  follow  the  sys- 
tem's initial  transient  resulted  in  divergence  occuring  before  100  seconds. 

As  in  the  case  for  w in  Filter  I,  the  results  indicate  that  Filter  II 

LbZ 

can  provide  a conservative  estimate  of  all  of  the  states,  i.e.  with 
computed  error  variances  at  least  as  large  as  "true"  system  errors,  over 
the  first  100  seconds  of  the  tracking  profile.  That  the  divergence  of 
this  filter  may  not  be  due  solely  to  the  nonlinearities  inherent  in  the 
profile  under  study  will  be  discussed  in  the  next  section. 
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Figure  35.  Filter  II,  Error  Standard  Deviation  of  Range  Estimate 
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Discussion  ami  Interpretation  of  Results 

The  author  considers  the  results  presented  in  the  last  section  to  be 
informative  but  rather  misleading  for  both  proposed  filter  models.  The 
above  judgment  is  based  upon  a comparison  of  the  results  (which  are  dependent 
upon  the  limitations  inherent  to  a covariance  analysis)  with  expected  actual 
filter  performance. 

Consider  the  calculation  of  the  inertial  acceleration  of  the  satellite 

T 

with  respect  to  the  tracker,  coordinatized  in  the  tracker  frame,  (A^)  , 
for  Filter  I.  We  know  that 


(VT  - (vT  - (vT  “ cI(vT  - (vT 


- (A^1  (6-2) 

T 

where  (A^)  is  available  to  the  filter  from  accelerometer  measurements. 

• • • 

But,  the  accelerations  X,,  X.,  and  X,  are  functions  of  X,  -*  X,  and  in 

4 5b  I b 

actual  implementation  would  be  calculated  using  the  most  recent  estimates, 

“ + * + 

X,(t.)  -*■  X,  (t.),  provided  by  the  filter.  But,  in  fact,  the  estimates  of 
the  satellite  inertial  position  and  velocity  states  will  be  rather  poor 
because  of  1)  the  weak  coupling  with  the  tracker  states,  and  2)  the  in- 
adequate satellite  dynamics  model  used  in  the  Filter  I formulation.  As 
shown  by  Meyers  (Ref  15:346),  a satellite  dynamics  model  that  does  not 
include  at  least  the  J2  gravitational  potential  term  - which  models  the 
effects  of  the  earth’s  oblateness  - will  cause  rapid  divergence  of  the 
state  estimate  in  an  extended  Kalman  filter.  The  good  results  obtained 
for  Filter  I,  therefore,  are  in  all  likelihood  due  to  the  fact  that  for 
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a covariance  analysis,  X is  not  available  and  all  time  varying  expres- 
• • T T 

sions  (X,  -+  X, , (A  ) , and  3 (A  ) /3X,  X_)  are  evaluated  along  a pre- 

s b r r I J 

determined  nominal  trajectory  X . Therefore,  if  Filter  I were  implemented, 

— n 

one  would  expect  that,  on  the  average,  the  filter  would  perform  worse 
than  the  results  of  this  study  imply. 

The  results  do  indicate  that  we  could  expect  this  reduced  order  sys- 
tem model  to  perform  well  if  the  satellite  acceleration  state  equations 

• • • 

for  X.,  X, , and  X,  were  more  accurately  modeled  to  insure  that  the  filter 
4 5 o 

A <•» 

estimates  X,  -*■  X,  do  not  diverge  from  the  actual  trajectory  when  the  filter 
is  implemented.  Besides  adding  the  J2  gravitational  potential  term,  model- 
ing of  the  atmospheric  drag  acceleration  is  suggested,  since  results  have 
shown  that  this  effect  is  on  the  order  of  J2  when  satellite  orbital  alti- 
tudes are  less  than  500  miles  (16,247).  The  ballistic  coefficient  need 
not  be  added  as  another  filter  state.  In  most  satellite  tracking  situa- 
tions, a good  estimate  of  this  parameter  will  already  be  available  and 
can  be  entered  by  the  operator  from  keyboard  as  a system  parameter.  Should 
these  changes  be  made  to  the  Filter  I model,  a Monte  Carlo  analysis  should 
be  performed  to  evaluate  large-scale  filter  performance.  A covariance 
analysis  would  probably  give  results  very  similar  to  those  presented  here 
for  the  tracker  states  and  would  prove  very  little  about  eventual  actual 
filter  performance. 

The  results  for  Filter  II  were  not  as  good  as  originally  expected. 

However,  an  examination  of  the  Filter  II  formulation  (see  Chapter  V) 

reveals  a probable  cause  for  the  divergence  of  this  filter.  Both  filters 

were  evaluated  using  the  same  perturbation  truth  model,  which  itself  was 

evaluated  along  a highly  accurate  nominal  trajectory  - X^.  Whereas 
T 

(A^)  in  the  Filter  I and  truth  model  representations  were  evaluated 
along  X (which  led  to  misleading  results  as  discussed  above)  using  a 
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highly  accurate  model  for  X^,  X,.,  and  X^,  (A^)1  in  the  Filter  II  formula- 
tion was  calculated  online  according  to  Equation  (5-33) 


>T  vLS  r >T  ^(V1  + (R3T)LS] 

(A  ) = (Av  - (A„)  = -U& 

^ ^ ^ ® I (VI 


(6-3) 


In  all  likelihood  the  second  filter  formulation  probably  diverged  in  the 
covariance  analysis  for  the  same  reason  that  the  first  filter  would 
diverge  if  actually  implemented  - insufficient  satellite  dynamics  informa- 
tion. There  exists  a good  possibility  that  Filter  II 

better  if  the  J2  and  atmospheric  drag  terms  discussed  earlier  were  added 

T 

to  the  onboard  computation  of  (A  ) ; time  limitations  prevented  the  author 

— r 

from  exploring  these  possibilities.  The  addition  of  the  atmospheric  drag 
terms  to  the  filter  would  require  a differencing  technique  applied  to  the 
satellite  inertial  position  information  to  obtain  the  inertial  velocity 
estimates  since  explicit  estimates  of  these  parameters  are  not  available 
in  the  Filter  II  formulation. 


Recommendations  for  Future  Study 

Several  simplifying  assumptions  were  made  in  order  to  limit  the 
scope  of  this  study  and  are  candidates  for  inclusion  in  future  work. 

1.  The  resolver  measurements  of  the  angles  <(>  and  6 were  considered 
to  be  perfect.  These  parameters  should  be  modeled  stochastically  and 
included  in  a future  filter  analysis  to  determine  the  sensitivity  of  the 
filter's  performance  to  these  variables. 

2.  The  sensitivity  of  a filter's  performance  to  both  accelerometer 
and  inertial  position  measurement  noise  corruption  should  be  studied  in 
future  work. 
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3.  A time  varying  Q profile  as  an  ad-hoc  function  of  the  angular 
rates  and/or  range  data  could  be  obtained  after  studying  a number  of 
representative  trajectories. 

4.  An  adaptive  Q technique  based  upon  the  real  time  evaluation  of 
the  innovations  (residuals)  sequence (s)  could  be  studied. 

As  a follow  on  to  this  work,  the  author  highly  recommends  that  the 
Filter  II  formulation  be  reevaluated  using  the  changes  suggested  in  the 
last  section  - the  addition  of  J2  and  possibly  atmospheric  drag  acceler- 
ations to  the  satellite  dynamics  model  - in  a Monte  Carlo  analysis.  The 
Filter  II  formulation  may  require  as  little  as  50%  of  the  computer  memory 
requirements  for  Filter  I (Ref  3:346)  - though  this  may  be  increased  a 
little  by  the  differencing  technique  required  to  determine  X^,  X^,  and 
X, . Should  the  Filter  II  formulation  continue  to  diverge  - as  well  it 

D 

might  in  a highly  nonlinear  angular  rate  scenario,  time  varying  or  adaptive 
noise  techniques  should  be  explored. 

The  feasibility  of  the  Filter  II  formulation  has  been  proven  in  this 
study.  Any  subsequent  studies  should  necessarily  contain  tradeoff  anal- 
yses with  the  overall  objective  being  to  meet  the  required  system  perform- 
ance specifications  with  the  simplest  (least  demanding  in  terms  of  computa- 
tion and  memory  requirements)  filter  model. 
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Appendix  A 


Linearization  of  the  Truth  Model  State  and  Measurement  Equations 

The  purpose  of  this  appendix  is  to  develop  the  partial  derivative 
matrices,  Fs  nnd  H^,,  for  the  truth  model  dynamics  and  measurement  equa- 
tions defined  in  the  summary  to  Chapter  II.  The  results  presented  here 
are  different  than  those  in  Mitchell's  previous  work  (Ref  4)  in  four 
respects. 

1)  The  accelerometer  measurement  noise  states  and  solar  pressure 
acceleration  state  have  been  deleted,  reducing  the  number  of  states  from 
61  to  42. 

2)  The  measurement  equations  have  not  been  substituted  into  the 
state  dynamics  equations  before  linearizing  - in  the  truth  model  the 
actual  dynamics  are  modeled. 

3)  The  partials  of  the  drag  acceleration  have  been  changed  to 
reflect  the  fact  that  the  inertial  velocity  vector  of  the  satellite 
relative  to  the  atmosphere  is 


I A 


X.  + u X. 

4 e 2 

Xc  - w X, 

5 el 


and  not 


X4  + “eX2 
X5  " UeXl 
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as  was  used  extensively  in  Appendix  B of  Mitchell's  work. 

4)  The  gravitational  forces  in  the  rotating  frame  are  calculated 
according  to 


9U 

3Xr 


9U_ 

3ZR 


where  U is  the  gravitational  potential  defined  in  Equation  (2-4).  The 
gravitational  forces  in  the  inertial  frame  are  then  found  by 


(a/  - 


In  order  to  linearize  the  state  equations  for  the  extended  Kalman 
filter  formulation,  the  second  partials  U with  respect  to  Xj . X^,  and  X^ 
must  be  found.  The  method  used  to  accomplish  this  is  a one  sided  differ- 
encing technique  suggested  by  Pollard  (Ref  12)  with  a differencing  step 
size  of  one  meter.  The  differencing  is  accomplished  in  the  rotating 

coordinate  system.  Letting  indicate  the  matrix  of  second  partials 

R 

of  the  gravity  potential  with  respect  to  the  rotating  frame 
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U 

32u 

v 

K 

1 

3xryr 

l_ 

92U 
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then  the  matrix  of  the  second  partial  derivatives  taken  with  respect  to 


the  inertial  nonrotating  earth  centered  coordinate  (I)  frame  U can  be 
found  using  the  following  similarity  transformation  (Ref  13:28) 

U = ( cbT  U C*  (A-2) 

I R 

This  is  as  opposed  to  the  following  form  that  was  used  by  Mitchell. 


U = C?U  (CV 

I R 


It  is  easy  to  become  confused  because  Broxmeyer  defines  Cj.  as  the  coor- 
dinate transformation  from  the  rotating  to  the  inertial  frame  (Ref  13:22)  - 
the  opposite  of  the  convention  used  in  this  and  Mitchell's  work.  The 
following  definitions  are  used  in  this  appendix. 


X^,X2,X^  = satellite  inertial  position  vector 


X.,X..,X,  = satellite  inertial  velocity  vector 

4 D O 


X^jY^.Z^  = moon's  inertial  (earth  centered)  position  vector 


X ,Y  ,Z  = sun's  inertial  (earth  centered)  position  vector 

o D u 


p = atmospheric  density  of  altitude  h 


p = mean  sea  level  atmospheric  density 
o 


V = velocity  of  satellite  relative  to  the  rotating  atmosphere 
a 


r = distance  from  satellite  to  moon 
ms 


r = distance  from  satellite  to  sun 
ss 


a)  = earth  rotation  rate 
e 


p©  = sun's  gravitational  constant 


p^  = moon's  gravitational  constant 


System  F Matrix 


Given  the  following  nonlinear  state  equation 


x(t)  = j^Cxa^t)  + Gg(t)  ^(t) 


the  matrix  of  partial  derivatives  of  the  dynamics  with  respect  to  the 


states  is  defined  as 


Fs(t) 


84(t) 


X (t) 
n 


where  X (t)  is  the  nominal  reference  state  trajectory.  The  determination 
— n 

of  this  matrix  is  very  straightforward  except  for  the  partials  of  the 

relative  acceleration  vector.  The  inertial  acceleration  of  the  satellite 

T 

relative  to  the  tracker  expressed  in  tracker  coordinates  (A^_)  is  deter- 
mined from 


(AJ1  = ^[(Rg)1  - (£/] 


(A-3) 


(is}1  “ h 


XA(1) 

XA(2) 

XA(3) 


and  thus 


(A  ) = A 


.0- 


X.  - XA(1) 
4 

X5  - XA(2) 

X,  - XA(3) 
b 


(A-4) 


Choosing  A as  an  example  to  work  with,  it  follows  that 

rx 
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A = C^S(1,1)[X  - XA(1)]  + C^S(1,2)[X  - XA(2)1 

X 1 


+ CjS(1,3)[X6  - XA(3) ] 


and 


9A 

= LS 

9X,  CI  U,l; 


r • i 

• 

• 

9X. 

4 

3X 

+ C^S  (1,2) 

3X5 

9X, 

+ C^S  (1,3) 

9X, 

1 

1 

1 

(A-5) 


• • 


9C 


LS 


where  X.,  Xr,  and  X,  are  defined  in  Equation  (2-2),  and  ■ ■ - - = 0, 

4 5 O C7A 


9XA 

= 0 because  they  are  not  functions  of  the  states.  The  inertial  X^ 
acceleration  is  defined  as 


X.  = A + A,  + A + A + W, 
4 81  dl  ml  S1  1 


(A-6) 


then 


• 9A  3A.  9A  3A 
9X  g.  d m s 

+ + 


9X1  3X1  gXj^  gXj^ 


9X, 


(A- 7) 


The  first  term  in  Equation  (A-4)  can  be  determined  using  the  relationship 
previously  derived  that 


u = (cVu  C« 

I R 


where  in  particular 


9A 

81 

— — = U0  (1,1).  Equation  (A-7)  can  now  be  written  as 

9X1  h 
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• 3AJ  3A  3A 

3X4  d m sx 

3Xj  = U2t(1,1)  + 3Xj  + 3XX  + 3Xj 


In  a similar  manner  we  define 


-•  3A , 3A  3A 

8X5  m^  s 

A " V +^T  + ^T  + ^T 


3Xfi  3Ad.  3A-  3ASl 

— = U2^(3,l)  + 3X^  + 3Xi  + 3Xl 
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In  the  results  that  follow 
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Where  the  figures  in  the  brackets  indicate  the  dimensions  of  the  various 
submatrices. 
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System  Hg  Matrix 


Given  the  nonlinear  measurement  equation 


W - + V't’ 


Hg(ti)  is  defined  as 
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where  X (t.)  is  the  nominal  reference  trajectory.  Assuming  that  the 
— n l 

constants  K^,  , and  are  all  unity,  then  HgCt^)  is  given  by 
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To  develop  the  Filter  II  model,  the  first  six  states  of  the  Filter  I 


model  were  deleted  and  the  inertial  acceleration  of  the  satellite  with 
respect  to  the  tracker  in  the  tracker  frame  was  defined  as 
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It  follows  that 
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